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I. INTRODUCTION 


Aeronautical applications have provided much of both the motivation and re- 
sources for recent advances in the field of controls engineering. In the quest. for 
ever improving performance, the field of aerodynamics matured to the point that 
only incremental gains were possible. Consequently, the thrust for improved perfor- 
mance turned instead to more innovative ways of controlling air vehicles— allowing 
for unstable open-loop dynamics, shrinking control surfaces, and eliminating mechan- 
ical command systems in favor of “fly-by-wire” systems. These innovations in con- 
trols permitted the industry to exploit innovation in aerodynamics. The multi-input 
multi-output (MIMQ) nature of flight dynamics, which severely taxed the methods 
of classical control design, and the fiscal resources available as a consequence of the 
industry’s vitality, fueled the development of the tools which for the moment are re- 
ferred to as “Modern Control.” Included in the list of the most recent tools available 
to the controls designer are controllers which are designed through the solution of 
convex optimization problems. The first general objective of this research was to 
demonstrate a methodology of how these theoretical advances can be implemented in 
aeronautical applications. 

The second phase of the research then built upon the first, and capitalized on 
the very recent convergence of several technologies. As suggested above, the pursuit 
for performance has led both the commercial and military aircraft industries into 
the realm of Relaxed Static Stability (RSS) aircraft. The benefits include enhanced 
maneuverability, lower drag, lower weight, and lower cost. Reduced static stability 
is achieved, in large part, by shrinking or eliminating surfaces or physical features 


whose sole purpose is to provide either control power or static stability. Consider- 


able industry and government attention has been focused on the question of how 
one quantifies the thresholds for satisfactory dynamic performance. A dramatic re- 
vision to the traditional flying qualities specifications, from MIL-8785C [Ref. 1] to 
MIL-1797 [Ref. 2] was principally in response to these types of issues. An ongoing 
NASA/Navy research effort has for several years been trying to quantify thresholds 
and metrics for satisfactory dynamic response [Ref. 3, 4]. Note, however, that the 
focus has been establishing metrics for satisfactory flying qualities (the dynamic be- 
havior observed by the aircrew). One published research effort (not associated with 
a specific airframe) has concentrated on the task of translating the flying qualities 
requirements into the domain of vehicle and controls design [Ref. 5]. In this 1987 
study, the absence of both an appropriate theoretical framework and the requisite op- 
timization tools constrained the controls design approach to classical methods. The 
very recent convergence of three key technologies: (1) the theoretical formulation of 
many controls problems as convex or affine optimization problems, (2) the develop- 
ment of efficient numerical methods for the solution of convex or affine optimization 
problems, and (3) the computational capacity of modern engineering workstations to 
execute such routines, now permits the formulation of these vehicle and controller 
design problems to be posed as tractable constrained optimization problems. This 
report proposes a theoretical formulation and demonstrates a methodology by which 
not only a vehicle’s control system, but the physical configuration of the vehicle itself, 
may be posed as a tractable constrained optimization problem. 

In the pursuit of the above general objectives, the research effort was comprised 
of three projects. The first involved simply the use of available commercial designs 
tools. The second involved the creation of controller design tools based on recent the- 
oretical formulations, and then their application to a simple design problem. Finally, 


the third area, the optimization of vehicle control power characteristics required the 


development of a theoretical formulation, the creation of the appropriate design tools, 
and then their application to simple design examples to illustrate the viability of the 
methodology. Though these three efforts may only seem loosely related, each of the 
first two projects had elements which were critical to the subsequent project(s). The 


next section provides an overview of each project and its specific objectives. 


A. SPECIFIC OBJECTIVES 

The first problem was pure H, design for the autoland control system of a 
I’-]4 aircraft. The F-14 is a carrier-based fighter manufactured by Grumman Corpo- 
ration, and was selected for various examples within this study because of the unique 


configuration of its control surfaces. This effort had several specific objectives: 


1. Investigate how H. control could be utilized to incorporate the F-14’s Direct 
Lift Control (DLC) in the autoland problem. DLC is a powerful aerodynamic 
control surface which can directly decrease or increase the lift generated by the 
wing by the symmetric deflection/ retraction of over-wing spoilers. The DLC 


is currently dormant in the F-14’s autoland configuration. 


2. Further develop and demonstrate a methodology whereby scalar weighting func- 
tions could be used to tune an H,, controller to meet classical performance 
requirements, including sensor bandwidths. This was an extension of the work 


of other authors [Ref. 6, 7, 8. 9, 10]. 
3. Introduce a methodology for the robustness analysis of nonhnear air vehicles. 


The design and analysis tools used here were commercially available, and the principal 
contribution of this section was the demonstration of a methodology for their use. 
Thougl: convex methods were not applied in this problem, the development of the 


methodology was necessary as a foundation for the second problem. 


The second phase of the work was a mixed H2 / H. controller design example. 
Again the I-14 autoland controller design problem was chosen. The objectives of this 


phase included: 


1. Development of the computational design tools which could solve the continuous 
and discrete time Hz / H. controller design problem. These problems had 
previously been theoretically posed by Rotea, Khargonekar, and Kaminer as 


convex optimization problems [Ref. 11, 12]. 


2. Demonstrate a methodology for the use of mixed Hz / H controllers. It 
was assumed at the outset that the methodology would be a derivative of the 


methodology demonstrated in the first design problem. 


This phase of the work provided the moderne skills and convex optimization skills 
which were necessary for the pursuit of the final phase of the research. 

With the first two projects complete, the foundations were in place to pursue 
the principal objective. The appropriate sizing of aerodynamic control surfaces is 
a current issue as the result of the trend towards Relaxed Static Stability (RSS) 
aircraft. The methodology in practice today is for the aerodynamic configuration 
designer to provide a controls designer with a configuration for which he is to design 
a controller that will hopefully satisfy the specified open-loop and closed-loop perfor- 
mance requirements. The controls designer only influences the configuration in the 
sense that if there is inadequate control power to achieve the desired flying qualities, 
the design is sent back to the configuration designer to provide more control power. 
Absent is a method by which the performance requirements can directly be traus- 
lated into an optimal configuration along with an accompanying feasible controller. 
Given that many common performance specifications are convex, the question posed 


was: “Is it possible, to formulate a convex controller design problem in which not 


just the controller, but the plant itself is optimized?” We will refer to this as the 
plant/controller optimization problem. The final phase of the research consequently 


had three objectives: 


1. Determine a theoretical formulation for the plant/controller optimization prob- 


lem. 
2. Design the computational tools necessary to implement the proposed solution. 


3. Create multiple design examples to illustrate and validate the proposed solution. 


B. REPORT ORGANIZATION 


The report 1s organized so as to separate the discussion of computation issues 
from the engineering issues. Consequently, the main body of the report exclusively 
discusses either theoretical issues or their applications. The computer codes and their 
relevant discussions are then found in the various appendices. 

The main body begins with an overview of the tools and theory which were 
then applied in pursuit of the above objectives. Chapter II presents a short discus- 
sion of convex optimization, and outlines the two numerical algorithms which were 
used to solve the convex optimization problems which occur in the report. Chapter 
[Il then presents the theoretical controls background upon which the research drew. 
Most important is the outline of convex and affine expressions for various control 
design problems. Because of the similarity of the two problems, Chapter IV presents 
the details of both the H, and mixed H2/ HH. design problems. This includes 
a description of the problem to be solved, and the methodology for both the syn- 
thesis and analysis of the resulting controllers. In both cases, a simulation exercise 
was performed to verify that the controller demonstrated the desired characteristics. 


Chapter V then presents a methodology by which the plant/controller optimization 


problem can be formulated as Linear Matrix Inequalities (LMI’s). ‘This formulation 
then permits the solution of the problem by convex methods. This chapter also in- 
cludes a number of examples demonstrating how various types of specifications can 
be accommodated by this methodology. Finally, Chapter VI provides a summary of 
the conclusions and recommendations of the report. 

The appendices form the balance of the report and include the final versions 
of the various computer codes used to generate the results found in the main body. 
MATLAB was used for all the programming, and so the codes are written either 
as function files, or m-file scripts. Appendix A presents the derivation and listing 
of the codes which were used to solve the continuous and discrete time Hz / Ha 
controller design problems. Appendix B provides the materials which supported the 
two F-14 design example problems. This includes the SIMULINK models used both 
to form the synthesis model and perform the nonlinear simulation. The scripts used 
to perform/analyze the design are also listed. Next, Appendix C presents a listing of 
the interior point codes which were used to solve those problems posed as LMI’s. The 
original versions of these codes were written at the University of Michigan, and were 
provided by Professor Pramod [\hargonekar. They were then substantially modified 
by this author to improve their numerical efhiciency and reliability. Finally, Appendix 
D presents the function files and scripts which were used to support and illustrate 


the plant/controller optimization material of Chapter V. 


Il. CONVEX OPTIMIZATION 


This chapter provides essential background material on the general classes of 
problems which were considered, and outlines the tools available for solving these 
problems. The first section reviews the foundational mathematical definitions. Fa- 
miliarity with these terms and relationships is a prerequisite, as they occur repeatedly 
throughout the report, and in part define the scope of this report. Next, the second 
section provides a brief overview of the two numerical tools which were applied in 
solving the various example problems. 

The following notational conventions will be observed in this report. Greek 
letters represent scalars or scalar valued functions (e.g. A € Ror ¢(r): R™ > R). 
Lower case letters represent. vectors (e.g. 2 € R”), with a subscript 7 indicating 
the zth element. Lastly, uppercase letters represent either matrices or matrix valued 
functions (e.g. Y € R"*™ or F(x). Pairs of subscripts on a matrix are the indices 
for a particular element of the matrix. A single subscript on a matrix indicates a 
particular matrix in a set of matrices. Additional notation will be mtroduced later, 


when flight dynamics conventions prevail. 


A. DEFINITIONS 
1. General 
In general, the optimization problems considered during this research were 


of the form: 


Given the vector space R”, and the scalar valued functions ¢(2):R” — R 
and w(r): R" —R, find r., €R", such that (x) is minimized, subject 


to w(x) < 0. 


—~] 


The function w(x) is referred to as the constraint function, and if 2(s) < 0, then 
s € R” is referred to as a feasible solution. The function ¢(z) is referred to as 
either the objective function or cost function. In practice, a (sub)optimal search 
was performed to find a Z54, ER” such that $(25.,) — (opt) < v, where yv was an 
arbitrarily small stopping criteria. 

The following mathematical definitions are important in describing various 
types of functionals. The definitions are extracted from [Ref. 13], but are standard 
across the literature. Consider the set X € R”. 

Definition 2.1 The set X ts “affine,” if for any rv, tT EX and anyA’ ER, Ar + (1 -— 
A)r € X. 

Definition 2.27he set X is “convex,” if for any xr, & € X and any X € [0,1], 
Ax +(1—A)r € X. 

Definition 2.3 The functional 6: X — R is “affine,” if for any x, x € X and any 
NER, o(Ar + (1 — A)zE) < Ad(z) + (1 — A) O(z). 

Definition 2.4 The functional 6: X — Ris “conver,” if for any x, t € KX and any 
X€ [0,1], d(Aa + (1 — Adz) < Ad(x) + (1 — AD O(z). 

Definition 2.5 The functional ¢ on the conver set X is “quasi-conver ,” if for any 
v, © EX and any d € [0,1], d(Av + (1 — A)@) < maz( G(r), O(2)). 


The following relationships can be deduced from the definitions: 
1. an affine set is convex , 
2. an affine functional is convex , 
3. a convex functional is quasi-convex, 


4. the reciprocal of an affine function is affine. 


CP 


The most significant fact relating convex sets and (quasi)convex functionals 
is that if (27) 1s (quasi)convex, and a € R, then the set X containing all x, such 
that #(r) < a, is convex. Similarly, if wv is affine and a € R, then the set X 
containing all 2, such that w(r) < a, is affine. These are referred to as functional 
inequality specifications. The practical significance of quasi-convex functionals and 
the convex sets represented by a functional inequality specification is that one is 
guaranteed to find the global minimum of an objective function to within a numerical 
threshold. Furthermore, if the set is bounded, then the argument minimizing the 
objective function can also be isolated. The advantage of convex functionals over 
those that are quasi-convex 1s the facility with which lower bounds can be computed 
during the optimization process, resulting in straightforward termination criteria. 
The reference [Ref. 13] contains additional information on the properties of convex 
sets and functionals, as well as illustrations and alternative tests for convexity. The 
optimization problem described above is a (quasi)convex optimization problem if the 
set satisfying the constraining functional inequality specification is convex, and the 
objective function is (quasi)convex. 

The optimization problem described above prescribed that the constraint 
functional w(r) be scalar. Many of the constraint functionals encountered in this 
report will be matrix inequalities of the form: H(r) = H'(xr) < 0. This is math- 
ematically equivalent to the scalar functional inequality: Amar(H(a)) < 0. Conse- 
quently, we can use the functional matrix inequality to notationally represent the 
scalar constraint:Amar(H(r)) < 0. Within all of the numerical algorithms applied 
here, it is the scalar constraint that is enforced. 

2. Linear Matrix Inequalities 
Consider the set of square, symmetric matrices Fo, f\,..., fy, where ff; = 


ee RR” for all z. 
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Definition 2.67he functional inequality F(a) > 0, r ER”, is a Linear Matriz [n- 
equality (LMI), af st-can be posed inthe form? (x) =i aa 

Note that the functional ¢(7) = Amar(—F(2)) is affine. Consequently, the LMI , 
F(x) > 0, represents an affine functional inequality specification. Though the above 
mathematical definition of affine only pertains to scalar functions, it is extended it 
to include all matrix-valued functions of the form F(x) = Fo + 0, rif%. In this 
context, we refer to F(z) as affine in z. 

Several forms of optimization problems exist involving LMI’s. The two 
problems of interest here are the Generalized Eigenvalue Problem (GEVP), and the 
Eigenvalue Problem(EVP). Let A(.c), B(x), and C(x) be symmetric matrix-valued 
affine functions of +r. The GEVP is defined as follows: 


Minimize: A 


Subject to: AB(r) — A(r) > 0, B(x) > 0, and C(r) > 0. (aly) 


The EVP is the simplified case where B(r) = J. The important distinction between 
the two classes of problems is that the EVP is a convex optimization problem, while 
the GEVP is quasi-convex (see [Ref. 14]). 
3. Schur Complements 
The following lemma wil] be very helpful in reformulating various matrix 
inequalities. 
Lemma 2.7 (Schur Complements) Let Q, S,. and R be matrices of compatible 


dimensions. Suppose Q = Q’, and S = S?. Then the following two statements are 


equivalent: 
Qe ait 
IE | RT eI. 





» O>0,5 20, and Oona 
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Specifically, Schur complements are the means by which many of the Riccati 


inequalities common to modern control theory can be reformulated as LMI’s. 


B. NUMERICAL ALGORITHMS FOR THE SOLUTION OF CONVEX 

OPTIMIZATION PROBLEMS 

Two numerical algorithms were used to solve the convex optimization problems 
of this research. At the point at which the research was undertaken, two princi- 
ple numerical tools were available to pursue convex optimization problems: Kelly’s 
cutting plane methods, and the Elhpsoid algorithm. The Elhpsoid algorithm was 
chosen both for it’s ease of implementation, and its attributes regarding problem size. 
Kelly's cutting plane methods were rejected due to a concern about the growth of the 
data storage requirements for the size problems being considered. Shortly after the 
implementation of the Ellipsoidal codes for several problems, Interior Point methods 
began to mature and receive substantial attention in the controls community. These 
latter methods are applicable only to those convex optimization problems which can 
be posed as LMI’s, but are reputed to converge much more quickly than the previous 
inethods. In each case, Professor Stephen Boyd of Stanford University was the prin- 
cipal figure responsible for the popularization of these tools in the context of control 
theory applications. 

This section provides a brief discussion of both of these methods. Only those 
details relevant to our specific implementation are addressed, as both these methods 
were regarded as means to an end. Details and convergence proofs, as well as further 
references regarding the history of these methods can be fond in [Ref. 13, 14, 15]. 

1. Ellipsoidal Algorithm 

The ellipsoidal algorithm is suitable for use in all quasi-convex optimization 


procedures, including LMI’s, and is mathematically guaranteed to find a optimum 


He 


solution to within a specified threshold. First of all, consider a problem in which 
one is simply trying to optimize an objective function ¢(7) without any constraints. 
Consider Figure 2.1. At each iteration /k, the search is characterized by a vector 
vw’) € R”, and an ellipsoid E™) centered about xr), whose size and orientation are 
defined by the positive definite matrix A“™) € R”*” (the eigenvalues of A) are the 
square of the magnitudes of the respective semi-axes of E'), while the eigenvectors 
of A) are their orientations). Assume that optimum point is located within E™), 


and let the gradient vector g be defined: g) = we) 


5 If d(2™)) = a, then d(z) 





rl k)” 


convex implies that ¢(r) > a for all x in that half of E™ in the direction of g). 
The optimum point must then lie in the other half of E“), and the half in the g(*) 
direction may be discarded from the search. Consequently, each iteration finds a 
new ellipsoid defined by (rt), AG@t)) eich completely contains the entire half- 
ellipsoid bounded by ((a™), A™)), and the hyper-plane orthogonal to g"*), in the —g"*) 
direction (the shaded area of Figure 2.1). The process is then repeated. Though the 
ellipsoid may elongate, the volume of the ellipsoid shrinks at a constant rate with 
each iteration, until the optimum point is isolated to suitable precision. Preferably, 
the ellipsoid should be initialized such that it includes the optimal point, though it 
is reportedly possible for the ellipsoid to migrate to capture the optimal point [Ref. 
sh 

This mechanism works equally well for constrained optimization problems. 
For the constrained problem, the new ellipsoid is used to either further isolate the 
feasible set defined by the constraint functional inequality, y(2) < 0, or reduce the 


cost function ¢(z). The algorithm progresses as follows: 
1. Evaluate w(a'*?). 


2. If «™) is infeasible (y(r™)) > 0), then find the gradient ane = > By 


le 





Figure 2.1: Graphical Depiction of the Ellipsoidal Algorithm 


i3 


eliminating the infeasible half-space in the direction oe anew smaller ellipsoid 


(x41) A(At1)) is determined. Provided that the search was initialized with a 


feasible point in the original ellipsoid, then all feasible points in (2), A‘) are 


retained in (2{*t"), AAt)))_ 


3. If x *) is feasible (yb(2™) < 0), then find the gradient ae = 2 Now the 


OF | ae 





half space is eliminated for which the objective function has values greater than 
(d(x *))), retaining in (2{**"), A+") all of the feasible points having objective 


values less than (¢(2"))). 


4. Next iteration 


Note that any number of constraint functions y;(r) could be considered sequentially 
in step 2 above. This structure is clearly ADaien in the ellipsoidal codes in Appendix 
A (such as h2infsyn). 

The various formulae for updating the ellipsoid can be found in the codes 
and in [Ref. 13]. The principal challenge in applying ellipsoidal methods was the 
derivation of the appropriate subgradients of functions which were not strictly differ- 
entiable. 

In practice, a deep-cut modification to the above algorithm was used [Ref. 
13]. The principal here was to use the value ~(2"*)) > 0 to shift the position of the 
hyper-plane in the —g‘*) direction so as to reject. more of the infeasible space with 
each iteration, improving the speed of convergence. 

2. Interior Point Methods 

Interior point methods for the efficient numerical solution of LMI’s are 
generally attributed to Nesterov and Nemirovsky [Ref. 16]. Their application to 
problems of interest to the controls community was then popularized by Boyd and El 


Ghaoui [Ref. 14, 15]. 
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Unlike the Elhpsoidal algorithm outhned above, the Interior Point algo- 
rithin is restricted to those optimization problems which can be posed as LMI’s. 
Computationally, the interior point methods are superior to each of the other meth- 
ods in part because the search is restricted to the feasible set (hence Interior Point), 
whereas both the Ellipsoidal and Cutting-Plane methods can exhaust tremendous 
amounts of computational energy on isolating the feasible set. Only a brief overview 
of the method is presented here, and the reader is referred to [Ref. 14, 15] for more 
thorough coverage. 

Consider the EVP above. By including A as the first element of the vector 


z (ie. 2 =[A x? ]"), and letting c = [1,0,....0], the EVP can be reformulated: 


Minimize: \ = cle 


a. 


SUljeChtO ba) a= > 0. 





Ci) 
Let AM) represent an upper-bound on A for iteration &. Let A??* represent 


the optimal value of the EVP, such that for all \“%)) > A, the LMI 


(ijn, - eed 
|? Le 2 al 





Pte) 


1s feasible, i.e., there exists a vector x satisfying the LMI. If we assuine that the LMI} 


has a bounded feasible set, then the function 
br) = lo (det F(2)7') + lo aa eee (2.2) 
| eats aot 


has a global minimum within the bounded set since both terms are convex functions 
of «. The first term of d(x) is a boundary function because its value goes to infinity 
as the boundary of the set {2 : F'(2) > 0} is approached. It is this property that is 
used to keep the search within the feasible set. The choice of boundary function is not 


unique, and while it is unusual to find the determinant in a computational routine, 


Id 


it is used here because both the gradient and Hessian of the boundary function are 
easily computed, and calculation of ¢(z) itself is not required. The analytic center of 


¢(x,X) is denoted as 2*(\“)), and defined by: 


r*(\)) := arg min, (log (det i ae ea + log “aor (2.3) 

The Interior Point method used here is based on the method of centers and 

is comprised of two nested loops. In the inner loop, given A‘*), the analytic center 

a*(X\")) can be found by Newton’s method. In the outer loop, A‘*) is decreased with 

each iteration, and the search for x*(A'*+!)) is initialized at 2*(\“)). Algorithmically: 
1. Initialize the problem at k = 0, with some feasible x! and A"), such that: 


N9)) — eT zl 
F(x) | 7% 
JaWndate x 


Me) = Seo eae es (2.4) 
3. Find the analytic center 7*(A“*+)) by Newton’s method. 


4, Update r™): 


REN) = p(t), (2.5) 
5. Next &. Return to step 2 until termination criteria satisfied. 


The variable 8 € (0,1) is a computational parameter, with @ typically small. Note 
that the second term of 6(r) in 2.2 is singular if 9 = 0. In the outer loop, 7™) 
represents the set of analytic centers, which is described as the path of centers, hence 
the method is referred to as the method of centers. 


Define the gradient (g) and Hessian (//) of ¢@ to be: 


Gilet — ae) (a vector) 
1B a ba — (a matrix). 


The following algorithm outlines the Newton search for the analytic center, r*(A™)): 
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1. Initialize the Newton search with 2!) = rf), 


(k,l), 


Ko 


Calculate each element of the gradient and Hessian of ¢ at x 
Ci 
MA) — Tel 


7 tk Dy a7 (kt)\—1 (kD\-1 pb CiC; ; 
I (ee) me (clei rte) Pi) + Gara een (2.7) 


gi(x'*"")) = tr (Fiz) Fy) + 


3. Determine the Newton decrement, 6, and the damping factor, a: 


(2) = fg (r))T A (alk) 1 g( alk) (2.8) 
ee + aft + ately mabe nae (2.9) 

4. Update the search: 
rFlFV) = a( kl) — a(e™ 9) A (a9) g( FD), (2.10) 


5. Next J. Return to step 2, unless termination criteria satisfied. 
Oe ce a er ala 


Details regarding the algorithm, including convergence proofs, termination criteria, 
and modifications, can be found in the above references. The interior point routines 
used for this research are discussed and documented in Appendix C. It is important to 
note that these routines are not problem specific but are suitable for solving any prob- 
lem which has been posed as a GEVP (EVP). Once the problem is so posed, then the 
interior point algorithm requires only the three sets of basis matrices { Ag, A1,..., An}, 


fomene..B.}, and {Co.Cy..+..Ca}. 


hg 


Ill. THEORETICAL BACKGROUND 


A wide range of interesting and powerful control problems can now be solved and 
applied as the result of recent advances in computational methods, computer capacity 
and theoretical control. The previous chapter outlined several of these computational 
tools. This chapter provides the theoretical background for the control design and 
analysis tools implemented in this report. 

Consider the multiple input multiple output (MIMO) feedback system depicted 
in Figure 3.1. For the purposes of this chapter, we shall consider only finite dimen- 


sional linear time invariant systems. The general problem of control design 1s: Given 


Figure 3.1: Standard-Feedback Configuration. 


G , find C such that the closed-loop system 7 (G ,C ) is internally stable, and such that 
the output vector z has some specified desirable character in response to either the 
liput vector w, or some specified set of initial conditions. It has long been recognized 
that inany traditional control problems, such as solutions to Lyapunov’s Equation, 
can be posed as a convex optimization problems. It 1s only with recent 1mprovements 
in computational capacity (hard and soft), that these problems have become numer- 


ically tractable. Simultaneous with the increase in computational capacity came the 
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realization that many other desirable control problems could likewise be posed as 
convex optimization problems. 

Initially, this chapter outlines several control problems which can be expressed 
as convex optimization problems. First, the #2. control problem will be defined 
and discussed. The pure H,. problem can be more rapidly solved by methods other 
than convex optimization, but its convex forms allow for several derivative problems 
of interest. Furthermore, it is the convex form that allows #H,, to be used as the 
foundation for solutions to the plant/controller optimization problem. Next, the 
mixed H2 / H, control problem (continuous and discrete time) will be discussed and 
outlined. Third, a convex constraint for closed-loop pole locations will be presented. 

After the presentation of the control design tools, the small gain theorems and 
the structured singular value will be discussed. By themselves, these are not design, 
but robustness analysis tools, and while not explicitly part of the convex optimization 
process, they can serve as a guide in formulating a synthesis model to design for 


robustness. 


A. Hy, CONTROL 
1. The co Norm 
Consider again the feedback system depicted in Figure 3.1. Let T2,(G ,C ) 
denote the closed-loop transfer function matrix from the input vector w of exogenous 
signals, to the output vector z of errors. Then the infinity norm of 7.,,(G ,C ) is 


defined as the supremum over all frequencies of its largest singular value: 


| Trw(G .C ) loo = Slit iC Gel eo ae 


where o denotes the maximum singular value of 7’. This is an induced norm from w 


to z, which can alternatively be expressed, 


I] Tew(G 5C ) lloo= sup{]] = |l2I] ew [les 1}. 


An interesting physical interpretation is that || 7..(G ,C ) || represents the peak 


power gain from w to z [Ref. 17]: 


I Teu(G sC ) lloo= sup rat 


pow(w 


where: 


The power interpretation clearly illustrates one of the many motivations behind the 
attention 7. work has received during the past decade. It is this property which 
will be exploited later, as specifications abound where a specified rms output level 
is permitted for a specified rms disturbance input. For example, the Dryden model 
of air turbulence specifies various levels of turbulence with rms amplitudes. This 
property of the #{,. norm permits us to pose many typical disturbance rejection 
specifications as H. control problems. 


Consider the following state-space representation of the closed-loop system: 


Fr+Gw 


a (3.1) 


2 
| 


ma 
E 
I 
———~ 
fy 
| 


where F' is stable. It is well known [Ref. 18] that |] 72. ||.o< y, if and only if there 


exists a real symmetric matrix, Y > 0, such that: 
FY 4YF! 4(VH? 4GS G7 Sie re ee eat (3.2) 


This Riccati equation is referred to as the #,, analysis equation. 


2. (Sub)Optimal #,,. Output-Feedback Control by Riccati Methods 
The H, (sub)optimal control synthesis problem is to find, among all con- 
trollers that yield a stable closed-loop system, a controllerC that minimizes || 7...(G .C) |l.x. 
Recent work [Ref. 18, 19, 20, 21, 22] has led to a simple and elegant approacli to this 
problem. 
Suppose that a continuous time state-space realization for the plant G depicted 


in Figure 3.1 can be written as 


P= Ato ews Bot 
ORR ae ee ee — ae ae oe Oe es) 
y = Cor t+ Dow 


Assuine that (C'9, A, Bz) is stabilizable and detectable, that D, has linearly indepen- 
dent columns, and that D2 has linearly independent rows. Recall that a Hamaltonian 


matriz is a matrix H of the form: 


where P,Q and R are real n x n matrices with Q@ and F symmetric. If such a 
matrix Hf has no imaginary eigenvalues, then the spectral subspace \_(f/) spanned 


by the generalized eigenvectors belonging to eigenvalues lying in the open left half- 
Ay 
AX 
\-(1). We will say that the Hamiltonian matrix H belongs to dom/( fic) if H has 


plane is of dimension n. Let the columns of | | denote a basis for the subspace 


no imaginary eigenvalues, and if .\; 1s nonsingular. If ff belongs to dom( Ric), define 
Ric( H) := X_Xy7' =: X. It is well known that Y is symmetric, P + RN is stable, 


and .X satisfies the algebraic Riccati equation: 
PX+NXP4+NXRX —-Q=0. 


The key mathematical result on #H, synthesis by Riccati methods is stated below. 


Theorem 3.1 Consider the system 3.3. Suppose 


I-A|B 
rank | ee D, | =7 + ARN lo = ee 
and 
Si Aen ’ =? 
rank | =, BE | = 1+ rank) ey si 


and let ¥ > 0 be a given positive number. Define 


ny) =| AT BADD DiC 9? By By ~ BaD, Di) B; 
MS [CVE = Di(Di Diy Di)Cr— A’ + CyDy(DDi)* Be 


and, 


I(y) = A’ — C(D2 D3)" ' DB; ye CiCi — C,(D2D3)'C2 
“07 = |e, = Dy(D2D4)""D2) BY —A + By D(D2D2)"1C 


There exists a stabilizing controller C such that ||Trullo. <7 uf and only if 
{. H(y) € dom( Ric) and X(y):= Ric( H(y)) ts positive semidefinite. 
2. J(y) € dom( Ric) and Y(y) := Ric(J(y)) ts positive semidefinite. 
3. p(X (VY (7)) < 7%. where p denotes the spectral radius. 


Then such a controller, C , is given by: 


ie : ee 


oa 

| 
a 
= PN. 
ll Il 


where 
Aw i= APY Bib Xe — Dine ee (3.5) 
Lg 2= (i= a eee ae (3.6) 


existence and computation of .Y(+) and Y(y) are standard matrix algebra 


problems that can be solved using a standard technique for solving Riccati equations 


u2 


based on the real Schur decomposition [Ref. 23]. The pair of Riccati equations associ- 
ated with H(y) and J(7) are referred to as the 7. synthesis equations. Specifically, 
the Riccati equation associated with //(7) 1s the state-feedback synthesis equation, 
while J(-+) is associated with is the H. filtering equation. 

Commercial software is available from several sources which implements 
this theorem to determine a suitable controller from the input state-space model 
[Ref. 24]. In practice, implementations of this theorem usually start with an arbi- 
trary upper bound ¥, on the achievable performance. The theorem is then used to 
perform a binary search in the interval [0, 7,] for the optimal value of 7. If +, proves 
infeasible, then it can be set arbitrarily higher. Once the binary search has deter- 
mined a sufficiently small interval in which the optimal value of + must lie, the search 
is stopped and a (sub)optimal controller C is computed using the right endpoint. of 
this interval for 7 in the formulae above. Controllers determined by this means are 
usually referred to as the central controller. These methods are not perfectly clean 
numerically, as in practice, ¥ and Y must be allowed to have very small negative 
eigenvalues. 

3. State-Feedback H.. Synthesis by Convex Methods 

In this section, extracted largely from [Ref. 25], we show that the fractional 
representation of memoryless (i.e., static) state-feedback controllers, i.e. KY = WY7!,” 
where Y > 0, can be used to reduce the state-feedback Hh. control optimization 
problem to a convex feasibility problem over the space of finite-dimensional real mia- 
trices. This fractional representation was first introduced by [Ref. 26], and will be 
used extensively throughout this report. 

In order to introduce this parameterization, we first answer the following 
question. Given a plant, G , with all the states available for feedback, characterize 


the set Aj,(G ) of all stabilizing memoryless state-feedback controllers. Suppose the 


Zs 


plant G is represented by the following equations 


r= Ar+B,w+ Bou 
Ga G + Du (dita) 


y= a, 


iQ 
I 

c 

I 


where x € PR", u € RY and z € R?. Let © denote the set of all real 1 x m symmetric 


matrices, and define 
Dil (BN euler near eet): (3.8) 


Note that Q is a strictly convex open subset of RI*" x 
We now make the following assumption: 
Al. The pair (A, B2) is stabilizable. 
Assumption Al is necessary to guarantee that A,,(G ) is not empty. 


Theorem 3.2 Let G be given by equation (3.7). Define 
L(W,Y) := AY + YA'+ BoW + W'B. (3.9) 
C'onsider the set 
O2= {Werk ew: LUV ead 


Then An(G ) is nonempty tf and only if ®,, is nonempty. In this case ®,, ts conver 
and the mapping 
Oe Day) AGG | (Vien a= alee 


is onto. 
Proof. Suppose WV € A,,(G ). Then it follows from Liapunov stability 


theory that there exists Y > 0 such that 
(A+ BN)Y +YV(A+ BN) <0. (3.10) 


set: = Wt) insti) Stoveerseine a 


Couversely, suppose (W,¥) € ®,,. Set 4 = WY"! in (3.9) to get (3.10). 

Finally, convexity of ®,, follows from the convexity of the mapping ) —- 
L(Y), which is linear and, hence, affine and convex. a 

Next, we proceed to similarly parametrize the set of all memoryless stabi- 
lizing state-feedback controllers, which also make the infinity norm of the closed-loop 
transfer function 
\|T2w(G, IV) ||. less than a given number 7 > 0. We denote this set Asom(G ). The 
importance of this theorem is in the fact that it parametrizes A.w.m(G ) in terms of a 
set of solutions to a convex QMI (quadratic matrix inequality). 


Theorem 3.3 Let G be given by equation (3.7) and let y > 0. Define 
R(W.Y) := AY+Y A'+ BoW+IV' BU +(CLY 4D, W) (CY +D,W)+B, By /y?. (3.11) 
Consider the set 
Cer = ea) yy) = 0), 
Then Asom(G ) is nonempty, tf and only if Pn. 1s nonempty. In this case Bmioo ts 
conver and the mapping 


Y : D moo ais Aa ) . (WW, va) — wy! 


is onto. 
Proof. Without loss of generality assume 7 = 1. Suppose A € Assm(G ) is 
given. Then, it follows that there exists ¥ > 0 such that the 2H. analysis inequality 


Pe owicesatisned: 
(A+ BN)Y +Y(A+ BW) + Y(C, + DWN)(C, + DN)Y + BB, <0. (3.12) 


pet = iy in (3.12) to get (3.11) 
Conversely, suppose (W,Y) € ®,.. are given. Set 4 = WY! to get 


(3.12). Then it follows that WK € An m(G ). 
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The convexity of ®,,.. is proved in [Ref. 11]. a 
By Schur complements, inequality 3.1] 1s equivalent to the following LMI 


[Ref. 15, 20]: 


_| AY+YA'+ B.W+W'B,+ BiB, (CY + DW)’ 


Ry(W,Y) := (CY + DW) 42] <0. WiGaes 


This LMI expression is superior to the QMI 3.11 in two respects. First of all, it is 
affine in the controller parameters W and Y,, Secondly, the LMI is also jointly affine 
i y*. Consequently, while Riccati methods can only find a controller for a specified 
+, and methods such as bisection are required to find the optimal 7, convex methods 
using the LMI expression can find a (sub)optimal y and associated controller directly. 
Similar expressions exist for the output feedback synthesis problem [Ref. 27]. This 


[LMI will figure critically in our formulation of the control power optimization problem. 


B. MIXED #2, / HH. CONTROL 

Multi-objective control, and most specifically, mixed #2 / #(., control has re- 
ceived considerable attention in the controls literature in the past several years (see 
[Ref. 28, 12]) and references therein). This section presents the theoretical results 
which provide for the convex solution of the mixed problem in both continuous and 
discrete time cases. These results are largely extracted from [Ref. 28, 12]. 

1. Continuous Mixed H, / H, Control 

Consider the finite-dimensional linear time invariant (FDLTI) system de- 


picted by Figure 3.2. The objective of the underlying problem is, given G , find C , 





such that the generalized #2 cost of the closed-loop system, | 


Teou(G ,C )\l2, is min- 





mized, subject to the constraint that ||7:,u(9 ,C )llo < y. The generalized H) cost 


is defined as: 





ey: 
IT ew lo, sm f (— | Tel jw)T 3, (jue ee). (3.14) 
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Figure 3.2: The H2 / HH, Synthesis Framework. 
where f(-) can be either 1) the trace, 2) the maximum eigenvalue , or 3) the maximum 
diagonal element. The reader is referred to [Ref. 29] for a discussion of the attributes 
of these norms. 
Suppose Ajxm(G ) is nonempty, 1.e., a controller, C , exists such that 


ley ,C il, < 3. The set defined by A,..,(¢ ) is then referred to as the set 








of feasible controllers. In [Ref. 28, 30], the authors introduce an associated cost, the 
mixed H2 / H. norm (|| - |l2s), which they prove is an upper bound to the gener- 
alized H, cost. The Hz / H. problem can then be considered as a search over the 
set of feasible controllers for that controller which minimizes ||Tz5u(G ,C )|les.-. Fur- 
thermore, the determination of a controller, C , which minimizes ||72,0(G .C )Il2/oo; 
subject to ||T2,u(G9 .C )Ilao < y,. 18 posed as the following convex optimization problem. 

Consider the following state-space representation of the closed-loop system 


T4(G ,C ), where C is feasible: 


ty P= oF Ge 
Cr] es, = Fig ow yet os) 
-] = gee ah Jiw 


We know from equation 3.2 that there exists a unique symmetric matrix )°. such that: 
FY +YF'+(Y A? + GJ?) 1 - AJ?) (WY +.AG")4 GG? =0. 


Moreover, if L. is the controllability Grammian of the pair (F,G), then 0 < L. < Y. 


ws) 
~] 


The generalized mired Hy /H. cost of the closed loop system is then defined as: 


Js(Teow) = flo HE ) a. 7 a8) 
Consider now the following state-space representation of G : 
r = Ar+Bywt+ Bou 
Gy eT tt Din 3.17 
yo = Coa aap 
Let mn := dim(x), and m := diam(u). Furthermore, assume that: (a) the triple 


(C2, A, Bz) is stabilizable and detectable, (b) the pair (A, B,) has no uncontrollable 
modes on the imaginary axis, and (c) Dy{B? D/,] = [0 J}. 

Suppose there exists a symmetric matrix Q > 0, satisfying the H. filter- 
lig equation: 


AQ + QA’ + Q(CIC, — C2 C,)0 + Bi BF =0. (3.18) 


Define the auxiliary quantities: 
Ag=A+t0CC, Bio t= OC "Bio — Be Cel on 


Let (WY) Ee {WY:WeER™" Y €R™" Y =Y7 > 0}. Finally, define: 


R(W.Y) := AgY + YAQ + BogW + W’ Bog + Big Bi1Q" + 
(Cy De Caer oe (3.19) 
MWY) = "COCs Gar sae iamui@a) eet alan (3.20) 


Note that equation 3.19 is identical to 3.11. 


Let ® define the set of feasible solutions: 
$= 1 (WV) 2Y 7 = OR aey eal Gam 
aud consider the optimization problem 


o, := inf {f(M(W.Y)) :(W,¥) € ®}. (323) 


~ 
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Theorem 3.4 The set of feasible controllers, Acscm(G ), 1s not empty, tf and only tf: 
(1) A stabilizing solution Q > 0 extsts to 3.18, and (2) the set ® ts not empty. If a 


feasible controller exists, then 
Ip (Tegu(G «C )) 2= FUM(AV,Y)). 


Moreover, given anya > of, there exists a solution ,(W,Y) € ® such that f(M(WLY)) < 
a, and the dynamic observer based controller 


Ag§ + Bogu + Bialy — C2€) 
WY-lé 


mufemavic aid J;(1.u(9 ,C )) <a. 


Cy 

ll 
etiam 
Ge ON 
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Consequently, if a feasible controller exists, then the problem of finding a 
(sub) optimal controller for the H2/ HH. problem can be reduced to the solution 
of a Riccati equation (3.18), and the numerical solution to the convex optimization 
problem: 

Minimize: f(Af(W.Y)), over (HY) € R™*" x R®™”, 

pubjectito MWe) | —<U.and ) =) 0. 

The solution to the state-feedback problem (Cy = /, D2; = 0) can be simply posed 
by eliminating consideration of the filtering equation (3.18), and replacing Ag = A, 
Big = By, and Bog = By in the expressions for R(W,Y) and Af(1V,}°) above. The 
conmolleris then C = h,,, = WY". 

The ellipsoidal method was chosen to code a MATLAB function file which 
solved the state-feedback design problem. A second routine was also written which 
solved the measurement-feedback problem by solving the filtering equation (3.18) by 
Riccati methods, replacing the state-feedback variables with the appropriate auxiliary 
plant variables, and then calling the state-feedback design function. Both of these 


codes and their supporting subroutines are developed and then outlined in Appendix 


A. 


et 


It is astraightforward matter to use Schur complements to pose each of the 
above matrix valued inequalities, 3.19 and 3.20 as LMI’s. Consequently, the numerical 
problem could also have been solved by the interior point method. 

2. Discrete Mixed H, / H, Control 

This section presents the theoretical results of [Ref. 12], which pose the 
discrete Hy / H, controller design problem as a convex optimization problem. The 
discrete time Hz / H. problem differs only slightly from the continuous time problem 
above. The most significant difference is that it is structured about full-information 
feedback for an auxiliary plant rather than a state-feedback solution. 

First of all, the definitions of the respective norms are predictably similar 
to their continuous time counterparts. The discrete time version of the generalized 


‘He norm 1s: 









As [Pau Ta,Me) dO), (3.24) 


|Pevllays = Sls f 
where the function f(-) is again either the trace function, the maximum eigenvalue 
(Amar), or the maximum diagonal entry (dar). The H. norm in discrete time can 


be defined as: 


|g ee creer AIC"), (3.25) 


6E(0 27] 
where Oma; denotes the maximum singular value. 
Suppose the plant, G , in Figure 3.2 is now represented by the following 


discrete time state-space model: 


or = Ar+Biwt+ Bou 
Cox a= Do, Ww + Doz 


~() = 
= : 3.26 
G sy) = Cyrt Dywt Dy ( ) 
y = Cor + Daye, 


where a denotes the shift operator (or)({k) := r(h + 1). Assume that (1) the triple 


(C9, A, Bz) is stabilizable and detectable, and (2) given any complex number z satis- 
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mame j2| = |, the matrix 
A-—cl B, 
C7 ae 
has full row rank. The solution to the output feedback problem makes use of a 
suitably constructed optimization problem defined next. 
Suppose a feasible controller exists such that ||Tzj.|/o <1. Then, it follows 
from [Ref. 31] that there exists a (unique) real symmetric matrix Q > 0 such that 


the matrices V and FR defined by 


Va OC Aap. (3.27) 
a) et) net 


(COC a CHO. aes. | (3.28) 


are positive definite. Moreover, Q satisfies the following discrete algebraic Riccati 


equation: 
Q= AQA' + BB - (3.29) 
C.QA! + De. P(Q)7 C.QA! + Dy BY 
Ci\QA'+ Dy, BF C,QA' + D,,Bi 
where 


| Da Di, Dadi C2 T AT 
PC) o | De. Dios ae i iv a QC; Cy I 


mic ene matrix 
C,QAl + Dy, By -1| C2 ae 
i | Ci:QA’ + Dy BY MQ) Cy 0) 


is asymptotically stable. This is the discrete time analog of the continuous time 


filtering equation expressed by J(y) in Theorem 3.1. With this matrix Q, define the 
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following matrices 


Z = AQCT + Bi Di — (AQC? + BD )V-(C2QCT + Dai Di) 
A = A+ VANE: 

Big t= (AQC] 4B DAV? + ZRA (COC Ds) )V tae 
Bo, = Bo + Lee Dy 


Cae _— OF 

Doe = (DO eeecee Vase 
Do2,4 := Doo 

Cie _— RO2G 


Dig = RV?(C\QCT + Dy DEV"? 
D2, — ape 


Finally, define the following matrix functionals: 


6 JLo wre 


TY. KO 
Ueno a) Cy Diz W By Di, 


b, + Boho , B, + Boh nf - Y 0 (3 31) 

Dy, + Digh2 Dy, + Di2k2 Oe i. 
M(Q) := CoQC; + DuiD5, — Dorlas (3.32) 

M(W,Y,Ko) := M,(Q)+ (Co¥Y + DooW)Y MCoY + DooW)? + 
(Doi + Do2h2)( Doi + Dice (3.50) 
Let ® define the set of feasible solutions: 
= 4 (W, Ye Orie One (3.34) 
and consider the optimization problem 

oy := inf {f(M(W,Y, X2)) : (WY, Ke) € O}. (3 36)) 


Theorem 3.5 The set of feasible controllers 1s not empty, if and only if: (1) A 
stabilizing solution Q > 0 ezists that satisfies the conditions of (3.27-3.30), aud (2) 


pA. Ifa feasible controller exists, then 


Is(Tegu(G «C )) = f(M(W,Y, Ko). 
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Moreover, given anya > of, there exists a solution , (W,Y, 2) € ®, and the dynaniuc 
observer-based controller (with input y and output u) 


Oe — 0A Pa yah aon w 
Ce or, (3.36) 
bes aaa, —— Cor) 


such that C ts feasible and J,(G ,C ) = f(M(W.Y, N2)) < a [Ref. 12]. 
To solve the output feedback generalized H2 / H. control problem using 


Theorem 3.5, the following steps can be followed: 


1. Verify that a feasible controller exists; this can be done by solving two standard 


H.,. Riccati equations [Ref. 31]. 


2. Perform the convex optimization problem: minimize f(A/(W,Y. A2)). subject 


to the constraints ¥ > 0, and L(W.Y, A2) < 0. 


3. Construct the output feedback controller C in (3.36) using the suboptimal so- 
lution (WY, A’2) obtained in step 2. Then, C is feasible and Js(G,C) <a; Le., 


(3.36) solves the generalized Hy / H. control problem. 


As with the continuous time problein, where the problem was reduced for 
state-feedback, the measurement-feedback discrete time problem can be reduced for 
any problem where the states and disturbauces are available for feedback. Consider 
the following full-information plant: 


Ar + Byw+ Bou 
Cor + Dow + Dozu 
Cee ee Oe ee i ot (3.37) 


Ak 
oe 


Though the full information structure is not realistic in applications, the solution to 


OL 


Y 
lI 


od 
| 


this problem gives a lower bound on achievable performance that might yield insight 


into more complex output feedback problems. 
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The above optimization problem can be reformulated for the full-information 
problem by omitting the solution of the Riccati filtering equation (3.27-3.30), omit- 
ting the formation of the auxiliary plant, and making the following replacements in the 
expressions for L and M]: A, is replaced by A, B;,, is replaced by B;, C4 is replaced 
by C;, and D;,4 replaced by D;;. The optimization functionals are modified by setting 
M,(Q) = 0. The resulting state-feedback controller is then C = Nyy, =[WY7', Ko]. 

The numerical routines which solve both the full-information and measure- 
ment feedback controller design problems are outlined in Appendix A. As with the 
continuous time problem, an ellipsoidal optimization routine was designed to solve 
the full-information problem. This function file could then either be used to solve a 
full-information problem directly, or be called by the measurement-feedback design 
code after the auxiliary plant had been occa This problem could also have been 
solved by interior point methods, and the LMI expressions of the matrix functionals 


can be easily be determined by Schur complements. 


C. POLE PLACEMENT BY CONVEX METHODS 


Pole placement is possibly the most common metric used to specify the per- 
formance of closed-loop systems. The following outlines a convex constraint which 
can be used to determine state-feedback gains such that a closed-loop system has 
eigenvalues within a specified circle. 


Consider the region D defined by 
Dee eg | rage (3.38) 


It is a disk in the left half plane with center (—q,0) and radius r. Let a :=q—r. 
Theorem 3.6 Given a state-feedback gain matrir XK € R°*", the eigenvalues of the 
feedback interconnection of Gand C= Kv le within D if and only if there exists a 


symmetric matrit Y > 0 such that the following Quadratic Matrix Inequality (QMI) 
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is satisfied [Ref. 32): 


Cn (Ae eect es (Ase al)? 


(A+ BN +al\(Y/r)(A+ Bh +al) <0. (3.39) 


By replacing AK with WY7~', this expression is equivalent to the following LMI 


by Schur complements: 


Si(W,Y) := 


(Atal)Y +Y¥(Atal)i 4+ (At al)(¥/r)(A+al)F+ RoW 
BoW((A+al)/r+1)7 +((A+al)/r+ 1)W' BI : < 0. 
(BW)? -\r 
(3.40) 


The set of state-feedback controllers with eigenvalues within D is therefore convex. As 
described in [Ref. 33], this constraint is perfectly suited for convex optimal control 
problems where the designer would like to restrict the search to those coutrollers 


whose eigenvalues lie in a specified region. 


D. ROBUSTNESS ANALYSIS BY STRUCTURED SINGULAR VAL- 

UES (2) 

This section contains a description of the principal tools used to assess the 
robustness of feedback systems. In particular, we are interested in the use of the 
structured singular value. The structured singular value (jc) was first introduced by 
J. Doyle in [Ref. 34] and since has proved to be a valuable tool for the robustness 
analysis of the closed-loop systems. In this section we briefly suminarize the results 
of [Ref. 34, 35]. 

Consider the feedback system shown in Figure 3.3. Let fi(G .C ) denote the 


feedback interconnection of the plant G and the controller C and let 7:.,(G .C ) denote 
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the corresponding closed loop transfer function from w to z. It can be shown that 





Figure 3.3: Standard feedback configuration with uncertainty block. 


any linear interconnection of plant, controller, and uncertainties can be arranged to 


match the nominal plant, G , having the following form: 


A |B, B, 
a Gy, Gy se . 
pales di CG { Du Di 


Cy Do Do 










where (C2, A, Bz) is stabilizable and detectable. For stability analysis, the controller 
can be absorbed into the nominal plant G . The LFT ( linear fractional transforma- 
tion) representation of the feedback interconnection of the nominal plant G and the 


controller C is given by 
Fu(G ,C ) = Gyr + Gy2C(T — Ga2C) "Gar. 


Recall that the #(,, problem does not explicitly address the issue of plant 
uncertainty. If, however, the plant uncertainty 1s modeled as an unknown but norm- 
bounded, stable dynamical system, with the inputs and outputs of the plaut uncer- 
tainty block included in z and w respectively, then #(,, provides stability robustness 


guarantees as a result of the following theorem: 
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Theorem 3.7 Small Gain Theorem [Ref. 36]. Assume Fi (G ,C ) ts stable and A 
belongs to a set 


BA:={A:A€ RHw,|lAllo < 1/4}. 


Then the feedback interconnection of Fi(G,C) and A is stable for all A € BA if and 
ouly uf 
\Pexs(GsC)lloo <7. 





Unfortunately, Small Gain Theorem can be unnecessarily conservative when 
applied either to robustness analysis or design. This conservatism can be reduced 
by using the extension of Small Gain Theorem to structured uncertainties. The 
structured singular value is the metric by which this extension is applied. In order to 


define the structured singular value, let 


A = { diag( Ay, Ao. seeeey AG 


& 


where A,;’s are stable FDLTI systems. Furthermore, let 
Ave {diag Aygo. ..2. ae 


where each A, 1s a complex matrix. 
Definition 3.8 The structured singular valuc pu( MI (jw)) of the compler matrix M (jw) 
is defined as follows: 


MM) = 0, fVAEA,, det(] + M(jw)A) £0 
ee) — ) sip {IAI : A € A. det(/ + M(jw)A) = 0, } otherwise. 


The importance of the structured singular value for studying robustness of feed- 
back systems is due to the following result [Ref. 34], which characterizes robust 
stability of a system in the presence of stable structured uncertainty. 

Theorem 3.9 Let 
BA ={A: AEA, Allan < 1} 


se 


Then the closed loop system of Figure 3.3 is stable V A € BA if and only of 


(NIE (6) a= sup(1(Fi(G.C) )(Jw) <<) 


Applying this theorem as a test for robustness is much less conservative than 
the small gain theorem itself. By restricting the set of uncertainty matrices to those 
with the specified structure, a much larger set of LFT’s, Fi(G,C), satisfy the stability 
criteria. In other words, for structured uncertainties, there is a large set of stable 


systems that fail the criterion of the small gain theorem, and yet satisfy the latter. 
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IV. THE DESIGN OF AUTOLAND 
CONTROLLERS FOR CARRIER- BASED F-14 
AIRCRAFT BY HH, AND H2/ HH. METHODS 


A. INTRODUCTION 
This chapter presents the results of the application of H. and mixed H2 / H.. 
synthesis techniques to the design of autoland controllers for a carrier based F-14 


aircraft. These efforts had several objectives: 


e Demonstrate a methodology for Hy, output-feedback controller synthesis. 
e Expand that methodology for use with H, / H. synthesis tools. 
e Demonstrate the use of the Hz / H, synthesis tools. 


e Demonstrate the feasibility of using Direct Lift in a multi-variable autoland 


controller. 


e Present a methodology for the formulation of uncertainty models based on flight 


test data. 


The nature of the autoland controller problem and the unique configuration of the 
I-14, made this problem ideally suited to these objectives. 

Carrier approach and landing ts a challenging multivariable control problem in 
which the aircraft states must all be carefully controlled in order to comply with 
multiple structural and safety-of-flight constraints. Automatic landing systems cur- 
rently in service on carrier-based aircraft. (including the F-14) incorporate nested 
single-input/ single-output (SISO) controllers. which generally seek to regulate the 


angle-of-attack with the engines in the inner loop, while aerodynamic surfaces such 
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as elevators or stabilators provide altitude control. Since neither the engines nor the 
stabilators can control the altitude state directly, their influence is indirect through 
a combination of other states. The F-14 has an unusual aerodynamic configuration 
which includes Direct Lift Control (DLC), thereby providing an aero surface with 
substantial authority to control altitude directly. Moreover, the DLC is driven by 
actuators whose bandwidth exceeds that of the other control surfaces. Regrettably, 
this powerful control surface is not used by the automatic landing system currently 
in service. In this chapter, two multivariable feedback controllers are presented which 
seeks to exploit this powerful, but dormant capability. 

To achieve this objective, the design methodology presented here was developed 
to enable the control engineer to translate the design requirements into weighting func- 
tions for H., synthesis. This methodology ene then further extended for use using 
the Hy / H. design tools. Most typical design requirements are SISO in nature, 
whereas the H. and H2 /H~ synthesis techniques are truly multivariable tools. 
Thus, the main feature of this methodology is a simple procedure for translating 
the SISO requirements into the various weighting functions for H, and Hz / He 
synthesis. Moreover, once the SISO requirements have been satisfied, the H.. frame- 
work offers a natural way to expand the weighting functions to satisfy multivariable 
stability and performance robustness requirements. 

This methodology has been applied to the design of control systems for com- 
mercial airplanes, autonomous underwater vehicles (AUV’s), flexible structures and, 
most recently, for unmanned aerial vehicles (UAV’s), see [Ref. 6, 7, 8, 9, 10]. In 
(Ref. 6, 7, 8, 10] this technique was used to synthesize state-feedback controllers. In 
[Ref. 9], where a controller for a flexible structure was designed, the methodology 
was extended to include an output feedback case. The methodology outlined here 


expands this previous work to include compliance with closed-loop sensor bandwidth 


AQ 


requirements. 
Specifically, the methodology offers a simple and effective way to design feedback 


controllers satisfying specified: 
e command-loop bandwidths, 
e control-loop bandwidths, 
e closed-loop damping, 
e closed-loop sensor bandwidths. 


Each of the above objectives are pursued through a specific formulation of the synthe- 
sis model and selection of the various weighting functions. Furthermore, it has been 
observed that an additional benefit of this methodology is that the resulting con- 
trollers do not cancel the undesirable modes of the open-loop plant. This is attributed 
to the suitable choice of weights to satisfy the closed-loop damping requirement. 
The appeal of this methodology is that the control designer is provided with a 
straightforward framework in which to implement H. or H2/ HAH. controllers in 
pursuit of typical design requirements without a detailed understanding of the the- 
oretical basis for these tools. Moreover, the results of the design effort are assessed 
using familiar SISO figures-of-merit. The availability of good comimercial software 
utilities, and ever-improving computational resources only enhance the viability of it- 
erative design methods such as the one presented here. This methodology is suggested 
as one means of placing these tools into the hands of practicing control designers. 
The controller design methodology we propose necessarily has a heuristic com- 
ponent. This heuristic component has been influenced by our experience in solving 
the practical problems mentioned above. Although we were successful in applying 


these design methodologies to this problem, we cannot offer any guarantees as to 
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whether their application to an arbitrary control problem will yield a satisfactory 
solution. 

Additionally, a method is proposed for accommodating structured model un- 
certainty in flight dynamics problems. Specifically, in using models extracted from 
flight test data, the uncertainty in the total value of lift, drag and pitching moment 
may be less than the uncertainties in individual stability derivatives. For this type 
of data, a method is proposed that considers the total uncertainties in these forces 
and moments rather than the uncertainty introduced by each term of the model. 
The robustness of the resulting closed-loop nonlinear system is then analyzed using 
established structured singular value methods. 

This chapter is organized as follows. Section B contains the material relevant 
to both controller design problems. This includes a description of the the carrier 
landing problem and the design requirements. It also includes the details of the 
uncertainty modeling process which was used to analyze the robustness of the closed- 
loop systems. Section C presents the details of the # controller design process, 
the implementation of the controller on the nonlinear system, and the analysis of the 
resulting closed-loop nonlinear system. Section D presents the details of the mixed 
Hy / H. controller design process, as well as the analysis of the resulting closed-loop 
system. A comparison of the two design methods and some concluding remarks are 


then included in sections E and F. 


B. PROBLEM STATEMENT 


The objective of the controller design is to provide for precise automatic control 
of the approach and landing of a carrier-based aircraft in the vertical and longitudi- 
nal axes. In this section we describe both the plant to be controlled and the desired 


performance specifications. These specifications are classical in nature, and are rep- 


resentative of those posed to control designers in industry. The notational convention 
adapted in this chapter was to use uppercase letters to denote total values of the vari- 
ables introduced, while lower case letters denoted the perturbations of these variables 
around their nominal trim values. 

1. Airplane and Model Description 

The design problem to be solved here deals with the longitudinal motion of 
a fighter airplane and the control of the longitudinal rigid body dynamics (by conven- 
tion, longitudinal flight mechanics refers to the motion in the 2-D plane spanned by 
the longitudinal and vertical axes). A complete description of an airplane’s equations 
of motion can be found in many available references. See, for example, [Ref. 37]. 
Consequently, we will not describe the equations of motion in detail. Rather, we will 
present a brief qualitative description of the key features. 

The longitudinal equations of motion of an airplane are described by two 
force equations (longitudinal force F, and vertical force F,) and one angular moment 
equation (pitching moment Af). The state variable associated with the fF, equation 
is the forward velocity U (along airplane’s body-fixed x-direction). The state variable 
associated with the F’, equation is the angle of attack a (the angle between the body- 
fixed x-direction and the true total velocity). The state variable associated witl: the 
M equation is the pitch rate Q. The integral of Q for a typical approach and landing 
condition is the pitch attitude O (the angle between the body fixed x-direction and the 
horizon). Other motion variables of interest are the airplane’s airspeed V, (generally 
not, aligned with the body-fixed x-direction), flight path angle y (the angle between 
\, and the horizon), and airplane’s altitude above sea level 7. All the angles used 
here are expressed in rad, angle rates in rad/sec, position variables in ft, position 


rates in fps, and accelerations in g’s. 
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While the above discussion is germane to the flight dynamics of all aircraft, 
the F-14 has a distinctive aerodynamic configuration due to environment in which 
it was designed to operate. Mission requirements dictated a variable-sweep wing 
for low drag at high speeds, with full-span flaps and slats, for very high lift at low 
carrier take-off and landing speeds. Control along the longitudinal axis is provided by 
two afterburning turbofan engines (Thrust). Pitch control is provided by symmetric 
deflection of two stabilators (Stab). In the landing configuration (gear down, wings 
fully forward, and flaps fully extended), Direct Lift Control (DLC) is provided by 
symmetric deflection of wing mounted spoilers. The neutral position of the spoilers is 
approximately 40% of full deflection, so as to provide for both positive and negative 
contributions to the lift. 

For the design study, the sensors available included onboard accelerometers 
and gyros which provide pitch attitude (0), longitudinal acceleration (N,), vertical 
acceleration (N,;), and pitch rate (Q). Total velocity (V,;), was provided by the air- 
craft’s air data system. Lastly, for automated approaches and landings, the altitude 
(/1) was determined by a shipboard tracking radar. 

The model used for the design process was a linear model obtained from 
a nonlinear simulation built using aerodynamic coefficient data. This simulation 
model was nonlinear in that while the aerodynamic derivatives were held constant, 
the equations of motion included the nonlinear influence of airspeed, gravity, as well as 
the dynamic coupling terms. The flight condition was a nominal approach condition 
of 230 fps, at sea level, with a gross weight of 54,000 lbs. The linearized longitudinal 
model iicluded five states: u, a, g, 8 and fh and three control inputs: é5145, d7hrust 
and dprc, where all the linear states and inputs are small perturbations around the 
nominal operating point. At this condition, the longitudinal rigid body motion of 


the I’-14 is characterized by two second-order stable modes, the phugoid aud short 
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period, and an altitude integrator. The phugoid involves perturbations in V; and H 
with nearly constant a@, whereas the short period mode involves perturbations in a 
and Q, with VY, and #H remaining constant. The short period mode had a natural 
frequency of 1.04 rad/sec and a damping ratio of 0.45. The phugoid had a natural 
frequency of 0.18 rad/sec and a damping ratio of 0.06. In addition to the plants five 
states, the actuators were modeled by three first-order transfer functions. These were 
appended to the control inputs and had bandwidths of 20, 2.5 and 50 rad/sec for 
the stabilators, engine, and DLC, respectively. As a result the complete system was 
represented by an eighth order linear model. 
2. Problem Description 

The general problem was to design a feedback controller which would satisfy 
the operational constraints imposed by the mission. The challenge of landing an 
aircraft at sea requires very precise control of the aircraft states. Ghideslope, which 
is the desired spatial trajectory of the aircraft, must be tightly controlled to provide 
for safety and to achieve the precise touchdown necessary to be arrested on the ship. 
The glideslope is an imaginary ramp oriented three degrees above the horizon, moving 
with the ship and terminating in the center of the landing area. In the case of manual 
landings, deviations from glideslope are detected visually by the pilot with a visual 
reference to a shipboard optical system. For automated landings, a precision tracking 
radar onboard the ship compares the aircraft’s position with an internally calculated 
glideslope, and transmits an error signal to the aircraft's flight control system via data 
link. Tight control of aircraft total velocity is driven by the competing requirements 
of providing for adequate aerodynamic perforniauce, while minimizing the kinetic 
energy that the airframe and arresting gear must absorb upon landing. Tight control 
of the aircraft attitude is required to prevent tailstrike. Both of these objectives can 


be achieved by controlling angle of attack with total velocity and the pitch attitude 


as dependent variables, functions of the angle of attack. Angle of attack 1s also an 
attractive control variable as consistent aerodynamic performance is achieved for wide 
ranges of gross weights. 

The approach-to-landing problem can be fully characterized by several 
combinations of the variables in the state vector due to the mathematical and aero- 
dynamic relationships between these variables. Likewise the control objectives can 
be achieved by tracking any one of these combinations. Systems in fleet use today 
incorporate nested SISO controllers, with the engine controlling angle of attack in the 
inner-loop and the stabilators controlling either sink rate or flight path. The remain- 
ing variables are then dependent functions of the gross weight and the two controlled 
parameters. In this design example, we propose to use DLC to provide independent 
altitude control of F-14 in approach and Pei Currently F-14’s DLC ts engaged 
for approach, such that the spoilers are deployed to their neutral DLC position. DLC 
is not utilized as part of the control system, however, and serves only to increase both 
the drag and the trimmed power setting (this 1s done in order to keep the engines in a 
more responsive range of operation). Neither the engines nor the stabilators provide 
control directly into the altitude state, but rather indirectly control the flight path./ 
altitude through the airspeed and pitch attitude states. Performance may thereby be 
sacrificed, as DLC is the only control effector which has control power directly into 
altitude through the vertical velocity, and DLC actuator is the fastest of the three 
available actuators. Given three independent control effectors with sufficient control 
power, F-14 has the resident capability to track three independent command signals. 
A multivariable approach to the control design would permit inclusion of the DLC 
in the control system resulting in both an enhanced capability and an improvement 
in performance. Therefore our control strategy was to track altitude (#7), and angle 


of attack (a), using stabilators, engines and DLC. Since the number of controllers 
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exceeds the number of command variables, the flexibility existed to wash out one of 
the controllers. We chose to wash out the DLC. The desired effect was that the thrust 
would control the glideslope in steady state, while the DLC would provide dynamic 
glideslope control. Thus, the design problem was to synthesize feedback controllers 
which tracked a glideslope signal, while controlling angle of attack in steady-state, 
given the available sensor suite. 
3. Design Requirements 

In light of the above, the #H. controller was required to satisfy the fol- 

lowing design requirements outlined below. These requirements will later be modified 


for the mixed Hz / H. design example 


1. Zero Steady State Error 


e Achieve zero steady state values for all error variables in response to step 
commands in angle of attack, and ramp commands in altitude (this was 
necessary for glideslope signal tracking and wind disturbance rejection), 


while washing out DLC in steady state. 


2. Bandwidth Requirements 


e The input-output command response bandwidth for all three command 


channels was to be approximately | rad/sec. 


e The control loop bandwidth was not to exceed 40 rad/sec for the DLC 
actuator, 20 rad/sec for symmetric stabilator, and 2 rad/sec for the engine. 
These numbers represented 80% of the corresponding actuator bandwidths 
to ensure that the actuators were not driven beyond their linear operating 


range. 


e The sensor response bandwidths were to be approximately 100 rad/sec for 
the gyros, accelerometers, and integrators, and approximately 5 rad/sec 


for the altitude, angle of attack and airspeed data. 
3. Closed-Loop Damping 


e The closed-loop eigenvalues associated with physical states were to have 
the damping ratio of at least 0.6. (This permits controller modes to have 


damping ratios less than 0.6). 
4. Robustness 


e The controller could not cancel the lightly damped open-loop poles of the 


plant 


e Simultaneous gain and phase margins of +6dB and 45 degrees in all control 


and sensor loops 


e Stability was to be guaranteed for simultaneous variations of 20% in the 


perturbed lift and drag forces and pitching moment. 


4. Uncertainty Modeling 

This section describes the methodology used for analyzing robustness of the 
closed-loop system consisting of the aircraft model and any controller. The aircraft 
model used in this chapter was obtained from the flight test data. As a result some 
of the terms in the model are poorly known. These terms include airplane’s lift, drag 
and pitching moment. On the other hand, terms such as gravity and aircraft dynamic 
coupling are known well. Furthermore, lift and drag are measured in the so-called 
stability axis, whereas the aircraft model was derived in the body-fixed coordinate 


system. These considerations indicate that the uncertainties in lift, drag and pitching 
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moment must be modeled exactly where they occur. Therefore, this should be done 
using aircraft’s nonlinear equations of motion wlule taking into account the coordinate 
systems where these forces and moments were measured during the flight test. A 
detailed discussion of this process is given next. 


Let r represent the vector of the longitudinal states of the aircraft: 
aes l TF. 
iO ae) Ogi |. 


Let 6 represent the vector of the aerodynamic control effectors, consisting of the 


stabilators and DLC, and let F represent the vector of body-axis forces and moments: 


if). ininence of gravity 


Fayn(v) := influence of dynamic coupling 
Fiero(®) := influence of aerodynamic forces on the body 
Poe, .= intiuence of thiust 
Fs := influence of aerodynamic forces on the control surfaces. 


Note that the first three are state dependent, while the last two are functions of the 

appropriate controllers. The aircraft equations of motion can now be expressed as: 
UJ 
a = Forav( it) + Fayn(v) + eae =r Lge) (leceel et) a Le. (4.1) 
QQ 

where f,,,(2) is the wind to body axis rotation matrix: 


—cosa sina 0 
ie | =< “=cosa Oo 'la (4.2) 


0 () 
We only consider uncertainties in the aerodynamic forces and moments, 


suice the gravity. dynamic coupling and thrust are all well known. 


AY 


The aerodynamic model of the airplane is derived using stability deriva- 
tives, which represent the contribution of each state and control input to the aerody- 
namic forces and moments acting on the airplane. This data can be obtained either 
in the wind tunnel, where isolation of individual contributions is frequently possible, 
or flight test, where only macroscopic behavior is observed, and then numerically 
distributed among the aircraft’s states and inputs. The stability derivatives obtained 
from the flight test data therefore depend upon very complex multivariable parameter 
identification (PID) methods, which are executed in two steps. First, forces and mo- 
ments are computed from observed accelerations and rates. Second, the PID process 
tries to identify which control inputs and airplane states contribute to the observed 
change in forces and moments. Tlis step clearly introduces errors not present in the 
frst computation. 

Our choice is then to consider either the contribution of the uncertainty in 
each parameter, or the net uncertainty in our knowledge of the forces and moments. 
There are several reasons to choose the latter. First of all, the size of the uncertainty 
model is significantly reduced. Secondly, the uncertainties in each stability derivative 
are not independent. If they were, then large uncertainties in each stability derivative 
will result in large uncertainties in the net forces or moments, leading to an unnec- 
essarily conservative design. Consequently, we chose to model the uncertainty block, 
A, as a3 x 3 diagonal matrix, where each diagonal element represented a percentage 
of the nominal perturbation in the aerodynamic forces and moments (drag, lift and 


pitching moment). Incorporating this block in equation 4.1 yields: 
U 
Qr == Forav(®) + Fayn(2) + Pikrust 4 fab) Oligo tee (4.3) 
Q 

igure 4.1 depicts equation 4.3. Here signals ws and zs denote the uncertainty inputs 


and outputs. 
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Figure 4.1: Uncertainty Model 


C. Hy, CONTROLLER DESIGN 
In this section, we will describe the key features of the controller design process 
which we followed. The section is organized into a number of subsections that em- 
phasize some of the important engineering issues that arose in the controller design. 
The MATLAB scripts and SIMULINK models used to pose and analyze the problem 
are outlined in Appendix C. 
1. Synthesis Model 
The first step in the controller design process was the development of the 
synthesis model which served as an interface between the designer and the Hy. 
controller synthesis algorithm. 
Consider the feedback system in Figure 4.2. The synthesis model was 
derived from the lhnear model of the airplane by appending the depicted weights . 
The weights became the “knobs” which the designer adjusted to achieve his specified 
performance. Here C is the controller to be designed, P is the hnear model of the 


I-14 and the block G within the dotted line is the synthesis model. The signal wy 


o1 


iw 





Figure 4.2: Synthesis Model 


represents the commanded inputs which were to be tracked: 


/ 
ww, = enya Vemd (pee 


The signal w2 represented the noise inputs to each of the sensors, and disturbance 
inputs to the states of the plant. The signal u. represented the control inputs to the 


system and was composed of the stabilator command, the thrust command, and the 


DLC command. The signals 7; and x2 are: 


asl nee (DIL) ra=(t a @ 6h). 

The signal ¢ represented the vector of the tracking errors (e = w,; — 2;). 
The outputs of W,,W2 and W 3 comprised the vector z. Since we required 
zero steady-state errors in tracking a ramp altitude command, and a step a and DLC 


commands, the weighting function W,; was chosen to have the following form: 


STi 
Ww=| 0 2 0 
00 8 


where the constants c), cz and c3 were adjusted to get the desired command response 
bandwidths. Thus, W, weighs the integrators on the regulated variable error channels. 
Furthermore, it was required to have full rank in order to satisfy the detectability 
assumption of Theorem 3.1. 

It turned out, that unlike W,, W2 and W3 did not need to include any 


dynamics. The choice for the weighting function IW was: 


C4 0 0 
W, = 0 ¢ 5 0 ; 
0 0 CGE 


where cy, C5, and cg were adjusted to achieve the desired control loop bandwidths; 
W, was also required have full rank in order to satisfy the full rank assumption of 
Theorem 3.1. 

Next, the reader will note that the elements of the vector x2 are the rate 
terms on the principal states of the plant. Selection of r2 1s an important element 
of our methodology. Applying the weight Ws to r2, and including these signals in 
z, penalized activity in their corresponding states. The effect was similar to that of 
creating rate feedback to augment damping, common to a classical controls approach. 
linportantly, W3 did not need to have full rank. This permitted us to set multiple 
weights to zero and use non-zero values only in the event that a particular signal was 


necessary to improve damping. As a result Ws had the following form: 


BY ao Oe) eer ta iene lle 


where c;’s were used to improve damping in a particular mode, as will be discussed 
in the next section. 
The vector y included the system’s sensor outputs. Furthermore, y had 


to include the integral error state in order to satisfy the (C2, A, B2) detectability 


assumption of Theorem 3.1. Consequently, y was comprised of: 


ema OAS: 
YS eer, 0 een ar ies , 
& S S 





One artificiality was introduced at this point: the presence of the integrated error 
terms in y lecessitated the inclusion of noise signals on those measurements within 
the synthesis model in order to satisfy the rank condition on D2. Since the bandwidth 
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of these “observations” were arbitrary, we set them to the highest frequency of the 
other observations. 

In summary, the cost function penalized a vector of the weighted integrated 
errors, the rates on principal plant dynamic states and the control inputs. The design 
process to be discussed is essentially a procedure for adjusting the weights on W,, W2 
and W3 in order to achieve the design specifications. 

2. The Design Procedure 


The design process is summarized next, followed by a detailed discussion 


of how each of the design steps were apphed to the design example: 


|. Set all W3 weights to zero. Use state-feedback design to determine weights for 


W, and W, to satisfy the command and control-loop bandwidth requirements. 


2. If damping was unsatisfactory, refine the state-feedback design by adjusting 
W3 weights to include lightly damped states in output z. These states were 
identified by examining the eigenvectors associated with lightly damped eigen- 
values of A + Bol sso, where As, was the state-feedback gain determined in 
step 1 above. The maximum element of that eigenvector corresponded to the 
state contributing most to the lhghtly damped mode. Increasing the weight in 
the corresponding W3 entry had the effect of damping the dynamic activity of 
that state. Readjust IV, and W weights to maintain the previously achieved 


bandwidth specifications. 


—~] 


Given W123 weights determined above, use measurement feedback design to 
determine the sensor notse weights in Wy necessary to satisfy sensor response 


bandwidths. 


. Determine the process noise weights in 44 by analysis of the broken-loop con- 


troller responses, adjusting the weights as necessary to match the cross-over 
frequencies that were observed for the state-feedback design. This step is simi- 
lar to Loop Transfer Recovery (LTR) technique developed for linear quadratic 


methods. 


. Readjust W, 93 as required to maintain previously achieved specifications. 


. Evaluate resultant controller using linear and nonlinear simulation. Adjust 


weights as necessary. 


. Confirm satisfaction of other specification elements: robustness, damping, and 


no cancellation of lightly damped open-loop poles. 


a. State-Feedback Design - Determining the W, and W, Weights 


The objective of this step was the determination of the appropriate W, 


and W’) weights to achieve the specified command and controller bandwidths. Visual 
inspection of bode plots for the broken-loop controller responses and the closed-loop 
command responses indicated which weight to adjust for the next design iteration. 
As a general rule, increasing the weight on the integral errors (W,) increased the 
bandwidth of the respective command response channel, and increasing the weight 
on the controller commands (W 2) decreased the broken-loop cross-over frequency. 
This 1s identical to the behavior noted in H2 design, and is consistent with intuition, 
.. increasing the relative cost of the integral error should increase the closed-loop 


responsiveness of that channel in order to rebalance the costs. Similarly, increasing 
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the relative cost on a specified control signal should decrease the amount of energy 
applied to that control channel, and result in a decrease of that controller’s bandwidth. 
While adjustment of the weight on a given term consistently had the desired effect on 
the corresponding bandwidth, internal coupling meant that the influence of a given 
weight was not unidirectional and occasionally resulted in wild variations in the other 
Bode traces, invariably in the most undesirable direction. Occasionally, significant 
variations could also be attributed to the binary search stopping on a value much 
closer to the optimal than the tolerance. Considerable time could be expended chasing 
the various Bode traces, if an orderly methodology was not followed. Generally, once 
a desired cross-over or corner frequency was attained, weights were then adjusted in 
response to adverse coupling effects to restore that value to spec before any further 
adjustment of other bandwidths. Table 4.1 depicts both the nominal performance 
and the refined performance for several iterations as the weights were varied. Each 
entrs presents the weight applied to the identified term in z in the numerator, and 
the resulting bandwidth in that channel in the denominator. The column for damping 
ratio represents the minimum damping ratio for all complex closed-loop poles. The 
frustration attendant with coupling across terms is evident from iteration two to 
three. Raising the second weight from the first to second iteration had successfully 
pushed the a response up to above one, but had an undesirable influence on the DLC 
response. 
b. Improving the State-Feedback Design: Rate Feedback for 
Damping 
By the third iteration, the bandwidths had been balanced close enough 
to the desired specifications to attempt improvement of closed-loop damping. The ob- 
jective here was to identify the principal states participating in under-damped modes, 


and increase the weight on their respective rates in the output z such that activity 


TABLE 4.1: STATE-FEEDBACK DESIGN: WEIGHTS/RESULTING 
BANDWIDTHS 
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it that mode was penalized. The intent was identical in philosophy to the purpose of 


rate feedback in classical control design. At the third iteration, the closed-loop sys- 
tem matrix (A + Bos.) had two complex pairs of eigenvalues with damping ratios 
of 0.55 and 0.43. The two eigenvectors corresponding to these under-damped modes 
pointed in the directions of the h/s and q states respectively. This indicated that 
h/s and q were the dominant participants in each of the two under-damped modes. 
Since h/s was a state internal to the controller it was disregarded, and attention was 
focused on enhancing the damping on qg. To improve the damping of these modes, 
the weighted output g was included in z and the value of the corresponding term in 
IW’, was increased to a non-zero value. 

Initially a very small weiglt was introduced relative to the other 
weights. Each time a damping weight was adjusted, the W, and W 2 weights were 
readjusted in response, to regain the bandwidth characteristics previously achieved, 
prior to further refinement of the damping weights. The eigen analysis was performed 
prior to each adjustment of the damping weights to identify the most active state of 
each under-damped mode, and to insure that a different mode with different modal 
participation had not become under-damped. In fact, by penalizing participation of 


q in the under-damped mode, the mode slifted into the a and @ states, requiring the 
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Figure 4.3: Broken Loop Controller Responses 


inclusion of a penalty against the respective rate terms. Rarely was more than one 
weight adjusted per design iteration, to preclude obscuring the influence of each ad- 
justment. A total of 24 iterations were required to achieve the design that approached 
both bandwidth and damping specifications. From Table 4.1, the weighting functions 


W,, W2 and W3 at the conclusion of this phase had the following values: 


0 0 Sw 
W=([0 = Of], W=] 0 0.01 0 |, Ws = diag(0, 10,5, 1,0). 
0 0 2 DO 


l'igures 4.3 and 4.4 depict the broken-loop controller responses, and the closed-loop 
command responses for this selection of weights. 
c. Output Feedback Controller Design - Selecting the Measure- 
ment Noise Weights 
The next step was to determine the weights to be applied to the 
measurement noise signals, which mathematically show up only in the D2 matrix 
of the synthesis model. Initially, the weights on the regulated output z determined 


by the state-feedback design process were used in the output feedback design. The 
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Figure 4.4: Closed-Loop Command Responses 


objective of this phase was to tune the controller such that the influence of each sensor 
channel on the controller did not exceed the expected reliability of the sensor. For 
example, if a sensor could be regarded as reliable at frequencies up to 10 rad/s, then 
the controller response to that sensor channel should roll off at a frequency less than 


or equal to 10 rad/s. Consider the following representation of the controller: 


c = Bes (4.4) 


Ve C6 


The frequency responses of the diagonal terms of the transfer function matrix 

(',(s1 — A.)~'B. were plotted to evaluate the influence of each channel on the con- 
troller (Figure 4.5). The outputs of this transfer matrix represent the estimates of the 
states of G in the presence of the worst case disturbance [Ref. 18]. By examination 
of the corner frequency for each of the ten channels of C2(s/ — A.)7'B,, the weights 
could be adjusted to achieve the desired sensor response bandwidth. Increasing the 
weight on a given term resulted in the bandwidth for that channel being decreased. 


This 1s stntlar to the results encountered in HH, design and 1s consistent with mtu- 
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Figure 4.5: Sensor Responses 


ition. Very little effort was required to find the appropriate set of weights since little 
coupling was observed between the sensor channels. The accelerometer bandwidths 
could not be exceed 10 rad/sec because of the internal dynamics of the controller. 
d. Output Feedback Controller Design - Selecting the Process 
Noise Weights 
The next step of the design process was the determination of the 
process noise weights. This phase was similar in execution to the “loop recovery” 
process of LTR, with a slightly different purpose. While the objective with LQG/LTR 
is principally the recovery of state-feedback robustness properties, the objective here 
was the recovery of the performance characteristics of the state-feedback controller, 
as reflected by the various bandwidth and damping specifications. Unlike each of the 
previous steps, in which a specific weight could be expected to control a particular 
trace on the graphs, this was not so for this phase. Additionally, there was coupling 
into the closed-loop sensor responses as the state process noise weights were changed, 


which required some additional adjustment of the sensor noise weights to maintain 
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the desired sensor response bandwidths. The final value of W4 was: 
00001 + diar(O.l,. 4.24. 001.001. 20).70.15, 102. 110-1455. 


e. Linear Simulation- Assessing the Controller Structure 

At this point the closed-loop linear system was simulated in order to 
determine whether reasonable actuator deflections were being used. and to ensure 
that an altitude ramp could be tracked while controlling @ to a desired trim value 
and DLC’ to zero. The closed-loop system was initialized to level flight and then 
expected to intercept and track an altitude ramp. While the altitude ramp was suc- 
cessfully intercepted and tracked, both a and DLC’ stabilized at values other than 
their respective set points. Examination of the transfer functions from altitude com- 
mand to a and DLC revealed only a single zero at the origin within each numerator. 
In both cases there was an additional zero numerically close to zero, but insufficient 
to provide the desired washout characteristics. To achieve these characteristics, an 
additional integrator was added to both channels in W,. A new controller was then 
obtained using this modified synthesis model with the same scalar weights determined 
above. This controller was then evaluated using the identical simulation, with the 
result that both a and DLC’ stabilized at their desired values. Finally, shght change 
in W, and W, resulted in the final determination of the bandwidths. The final values 


of the weighting matrices were: 


2 0 0 5 0 0 
Wi=!0 F 0 |, We=!| 0 01 O |. Ws = diag(0, 10,5, 1,0). 
00 5 eed eeall 


Figures 4.6 and 4.7 depict the resulting broken-loop controller responses and the 
closed-loop command responses. The Nyquist plots of the broken loop responses for 


each control input are shown in Figure 4.8. 
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Figure 4.6: Output Feedback Broken-Loop Controller Responses 
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Figure 4.7: Output Feedback Closed-Loop Command Responses 


3. Specification Compliance 


Figures 4.6 and 4.7 show all the control and command loop bandwidths 
as satisfying their respective specifications, with the exception of the a@ command 


response which is slightly low at approximately 0.8 rad/sec. The notch is due to the 
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Figure 4.8: Output Feedback Broken-Loop Nyquist Plot 


presence of a zero in the a command loop. No objectionable properties result since 
that channel 1s used to regulate a constant command rather than respond to changes in 
the command signal. The Nyquist plot in Figure 4.8 clearly depicts the simultaneous 
phase and gain margins requirements as being satisfied, with all three controller traces 
staying in the right half plane for all frequencies. Eigen decomposition of the closed- 
loop system revealed a complex pair of eigenvalues which failed the damping ratio 
requirement (0.45). Examination of the corresponding eigenvectors, however, revealed 
that no vehicle states and only controller states were participating in this mode. 
The next step was to ensure that the cancellation of the plant’s lightly 
damped modes by the controller had not occurred. The controller is a 3 x 9 matrix 
of transfer functions, and while cancellation may occur in one or several channels. 
complete cancellation would only occur if all the chainels had a common numerator 
term. See [Ref. 38] for a discussion of multivariable transmission zeros. Figure 4.9 
depicts the singular values of the open-loop control responses. The presence of a clear 


spike at the frequency of the lightly damped phugoid mode and a sinall bump at the 
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Figure 4.9: Control] Loop Gain Singular Values 


frequency of moderately damped short period mode indicates that the controller has 
uot canceled these open-loop poles. Numerical analysis revealed no transmission zeros 
in the controller, further confirming the absence of pole-zero cancellations. 
4. Analysis 

The robustness analysis was performed by determining the structured sin- 
gular value of a linearization of the closed-loop uncertainty model consisting of the 
nonlinear plant and the #(. controller, as discussed previously in section B.4. This 
linearization was performed about the trimmed operating condition, with the uncer- 
tainty inputs and outputs ws and zs included in the nonlinear equations of motion 
as shown in Figure 4.1. Figure 4.10 depicts the resulting structured singular value, 
where the peak value of 0.6 indicates compliance with the condition of Theorem 3.8 
and the robustness design specification. 

Note, had the design effort failed to yield the desired robustness, the design 
process could have been repeated with the signals ws and zs; incorporated in the 


synthesis model, and using either H, synthesis or D-K iteration [Ref. 35]. 
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Figure 4.10: Structured Singular Value Plot 


5. Nonlinear Simulation 

In this section we present the results of the nonlinear simulation of the 
H,. controller. First, the controller was implemented on the nonlinear plant using 
D-implementation methodology (see [Ref. 39]). The methodology is based on the 
observation that linear controllers are designed to act on the perturbations about 
the plant’s nominal trajectory. Next, as with the linear simulation performed in 
section C.2.e, the controller task was to intercept and track an altitude ramp, while 
appropriately controlling the other signals of interest. A vertical and horizontal gust 
field of moderate intensity (rms= 10fps) was included in the simulation. Results 
are depicted in Figure 4.11, where all the variables are shown as deviations from the 
trimmed level flight condition. The simulation was initialized in steady level flight 
with all surfaces at their trim positions. In response to the altitude ramp, the DLC 
and stabilizer deflected immediately to establish the appropriate descent rate. The 
result is a decrease in both a and ©. The altitude overshoots the ramp, and then 


corrects to the proper trajectory. Both the average angle of attack and the average 
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Figure 4.11: Nonlinear Simulation Results 


DLC wash-out to their desired trim values as the altitude error is nulled and the thrust 
decreases to stabilize at the new steady-state condition. Deflections and deviations 
are all well within reasonable practical values. This simulation validated the results 
of the design effort. 
6. H,. Design Conclusion 

A measurement feedback controller was successfully designed to provide 
longitudinal control] of an F-14 aircraft during automatic landing, and implemented 
on a nonlinear simulation. A key feature in the design was the exploitation of the 
aircraft's Direct Lift Control to provide for enhanced landing performance. Addi- 
tionally, a methodology was detailed whereby SISO performance requirements were 
achieved using #H synthesis. Finally the resulting controller was validated on the 


nonlinear simulation. 
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D. MIXED #2 / H, CONTROLLER DESIGN 

The purpose of this section is to present the design example demonstrating both 
an application of the Hz / H. design tools, and a methodology for their use. The 
previous problem was actually born out of a desire to fully develop the methodology 
for the pure AH, problem prior to its application to a more complicated mixed 
problem. Both the synthesis and analysis models used the identical MATLAB scripts 
and SIMULINK models as the above problem. The design tools for this problem were 
created by the author and are developed and outlined in Appendix A. 

1. Problem Description and Design Requirements 

The problem description and design requirements for this example were 

identical to those outlined in section B above, with slight modification. In order to 
demonstrate the attributes of the mixed design tools, a more severe robustness re- 
quirement was included. Specifically, stability was to be guaranteed for simultaneous 
variations of 40% in the perturbed lift and drag forces and pitching moment. In the 
previous example, the robustness of the closed-loop system was assessed after the 
design process. In this design example, it was decided to explicitly impose the ro- 
bustness requirement in the design process using the AH. feature of the design tools. 
To accommodate the increased robustness specification, it was decided to relax the 
desired performance requirement slightly. Rather than the command performance 
bandwidths of approximately one rad/sec which had previously been required, the 
desired command bandwidths were set at approximately 0.5 rad/sec. 

2. Synthesis Model 

The #H.,. design tools used in the first design example found the con- 

troller, C , that minimized ||T...(G ,C )||... The mixed H2 / H tools find the con- 


troller that minimizes the mixed cost: ||7.,u(G .C )|l2/0, subject to the constraint 
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7e,w(G ,C )\loo < y. Consequently, the synthesis model complexity was increased in 
order to accommodate the signal zo, which was not present in the previous example. 
From Chapter III, the mixed Hz /H. problem required that the synthesis model 
be posed in the form: 

= Ar+ Byw+ Bou 

= Cor + Doyw + Doou 


GS = Cie + Dye Pit 49) 


= Cox + Dow + Dou 


a x =e 


. 


In order to pose the problem in this form, consider Figure 4.12. This figure 
depicts the synthesis model where the signals were chosen to comprise each input 
and output vector. The choice of signals to include in w, zo and z;, as well as the 
various weighting functions, were determined both by mathematical necessity, and 


the objectives posed by the problem description. 


<0 





Figure 4.12: Mixed H, / H, Synthesis Model 


The vector z; consisted of the signals whose output energy would be limited 


by the H. constraint. Since the 7H. constraint was to be used to explicitly 
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achieve the specified robustness, the uncertainty input ws was included in w, and 
the output of the uncertainty model] zs, was included in z;. The uncertainty model 
depicted in Figure 4.1 was used to find a linearization of the open-loop system with 
the input vector ws, and output vector, zs. As the consequence of constraining 
|Te,wlG ,C )lo < 7, Tesu.(G >C )loo < -y would be guaranteed. The requirement 
that . | have full column rank necessitated the inclusion of the output of any 
pure integrators, and the requirement that D2 have full column rank necessitated 
the inclusion of the control inputs u, in 2; as well. In order to restrict the amount of 
conservatism that these two signals added to the H, constraint by their presence 


in 21, small attenuating values were chosen for the weighting functions Ws, and W,,. 


] 
After several iterations of the design process it was evident that double integrators 
would again be required on each of the regulated error channels. Consequently, the 


final weighting matrices on z, had the form: 


hors 


a2 


au 





W;, = i = diag 10 210 2.10) 


The second element of WW, was specifically smaller than the others because it multi- 
plied the thrust channel, whose units (bf) resulted in high signal amplitudes. The 
weighting function Wa was set to 0.4/ in order to scale the uncertainty model such 
ites. (9 +O Nico = Iltzul(G .C Ill < ¥ = 1 would satisfy the robustness spec- 
ification of 40% gross parametric variation. Each of these weighting functions were 
constants and not adjusted during the design procedure. 

The vector z9 represented those signals which would appear in the quadratic 
cost function. As with the previous pure #H,. problem, the weighting functions 
W,, W2, W3. and W4 consequently represented the degrees of design freedom, while 
constrained by the above H.,. specification. In order to achieve similar results as 


the previous example, zo was selected to be identical to the previous z, as was the 
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structure of the weighting matrices. To be able to adjust the command bandwidths, 
the integrated errors were again included in the output signal, resulting in the first 


weighting matrix having form: 


W, ~— 


ee %:|" 
= Oy = 
i Oi 


As in the previous problem, W2, W3, and W, were diagonal matrices of constants. 
3. The Design Procedure 

The design process was virtually identical to that outlined in section 2. 
above. The only exceptions were in the formulation of the synthesis model, as de- 
scribed above, and in the use of the mixed Hz / H. design functions outlined in 
Appendix A, in lieu of the commercial 7H. design tools. Due to lack of time, the 
design example was terminated with the design of a state-feedback controller, how- 
ever, Appendix A does include both the state-feedback and measurement feedback 
design routines. 

Since the procedure otherwise followed the procedure of the first example 
exactly, the details are omitted. The mixed Hz / H, design tools did permit the 
selection of which generalized mixed costs was to be used (trace, maximum eigenvalue 
or maximum diagonal element). Several iterations were done using both the trace and 
the maximum eigenvalue. It was observed that the trace was more appropriate to this 
particular methodology, in that it was easier to influence all of the various bandwidths 
by adjustments of the weighting matrices. Several bandwidths were comparatively 
insensitive to adjustments of the weights when using the maximum eigenvalue as the 
cost functional. This is consistent with intuition when one considers the geometric 
implications of choosing the trace relative to the maximum eigenvalue. Table 4.2 
summarizes the progress of the design effort using the trace. Each design iteration 


required approximately 30 minutes of cpu time on a Sparcl0 workstation. Step 9 
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TABLE 4.2; STATE-FEEDBACK DESIGN: WEIGHTS/RESULTING 
BANDWIDTHS 
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marked the point when the additional integrators were added to the weighting matrix 
W,. This altered several bandwidths slightly, though the scalar weights themselves 
were not adjusted between steps eight and nine. 

The above design resulted in two pairs of lightly damped eigenvalues, with 
damping ratios between 0.2 and 0.4. Modal analysis revealed that only the thrust 
was significantly participating in these modes, with no participation by the aerody- 
namic states. This was regarded as acceptable, and no further damping improvement 
was attempted. The weighting matrix W3 was consequently all zeros. Since the 
measurement-feedback controller was not pursued, the weighting matrix W, was left 
as all zeros as well. 

4. Specification Compliance 

Figures 4.13 and 4.14 depict the broken-loop controller responses, and the 
closed-loop command responses. Each of the broken-loop controller responses 1s less 
than the specification, indicating that the actuators would not be driven at frequen- 
cies greater than their bandwidths. The closed-loop command responses of 0.4 for 


the altitude and DLC channels were slightly less than the specification value of 0.5 
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Figure 4.13: Broken-Loop Controller Responses 


rad/sec. Figure 4.15 depicts the Nyquist plot for the broken-loop controller responses. 
The Nyquist plot shows the controller loops as satisfying the simultaneous phase and 
gain margins, with the exception of the DLC loop which slightly violated the out- 
side corners. It is interesting that the DLC loop stays outside the unit circle around 
(—1.0), as would be expected when using Loop Transfer Recovery Methods with a 
pure H, controller design tool. 

Figure 4.16 depicts the singular values of the open-loop controller response. 
The clear peak corresponding to the short-period frequency indicates that this mode 
was not canceled by the controller. 

5. p-Analysis 

Figure 4.17 depicts the structured singular values for the closed-loop system 
Ts,u,(9 ,C ). The peak yt value less than one confirms the robust stability of the 
system to uncertainties greater than the specified 40%. That the peak value is well less 
than one highlights the conservative nature of using H,. constraints for robustness 


when the uncertainty can be expressed in a structured fashion. 
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Figure 4.14: Closed-Loop Command Responses 
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Figure 4.15: Broken-Loop Nyquist Response 


6. Linear Simulation 
A linear simulation was performed in order to ensure that the resulting 
closed-loop system fulfilled the design requirements. Figure 4.18 depicts the response 


of the system to aramp altitude command. All variables are depicted as perturbations 
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Open-Loop Singular Values 
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Figure 4.16: Open-Loop Singular Values 


Closed-Loop Structured Singular Values 
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Figure 4.17: Closed-Loop Structured Singular Values 


from their trimmed condition. 


Since the command bandwidths are slower than those for the first design 
example, the response of the regulated signals to the altitude ramp is predictably 


slower. The desired wash-out characteristics are displayed, though, on altitude error, 
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Figure 4.18: Linear Simulation Results 


angle-of-attack, and DLC deflection. 
7. Mixed Hz, / H. Controller Design Conclusions 
The methodology of section ©. was successfully extended for use in the 
design of mixed Hz / H.. state-feedback controllers. Furthermore, a synthesis model 
formulation was demonstrated whereby the H2 / H.. design tools could be applied in 
order to achieve explicit robustness guarantees, simultaneous with other classical SISO 


design requirements. The final controller design was validated by linear simulation. 


E. CONTRASTING THE H,, AND #2 / HH, DESIGN TOOLS 
Because of the similar synthesis models and design methodologies, the effort 
required to implement the two tools was virtually identical. In fact, a single MAT- 


LAB m-file was used to prepare the two synthesis models, with only slight variations 
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required. A positive attribute of the H2/ HH. tools was that little procedural ef- 
fort was required to shift to the H, / H. tools from the H, tools. The mixed 
H, / H. design tools did demonstrate one significant disadvantage over the pure 
H. method. While the computation of a single #(., controller would require less 
than 30 seconds, the computation of an H2 / A controller for this 14 state problem 
required between 12 and 45 minutes, depending on the scalar weights chosen. This 
was partially attributable to the particular implementation of the convex optimization 
methods. The computational time could be probably be dramatically reduced with 
a FORTRAN or C implementation of the interior point method, rather than the el- 
lisoidal codes used here. However, even the most efficient optimization routine will be 
dramatically slower than the nearly direct computational means available by Riccati 
methods. Consequently, the mixed 7 / Hox tools should only be used in situations 


where the #2 norm ts an explicit expression of some specific design specification.) 


F. CONCLUSION 


This chapter demonstrated the application of H. and mixed H2 / H. con- 
troller design tools to the problem of autoland controller design. A methodology 
was presented whereby classical SISO design specifications could be translated into 
scalar weighting functions appended to the synthesis model for either controller design 
scheme. Furthermore, a methodology was presented for the modeling of uncertainties 
in flight dynamics problems, and was theu applied in the analysis of the robustness 


of the resulting closed-loop systems. 


V. INTEGRATED AIRCRAFT/CONTROLLER 
DESIGN BY LINEAR MATRIX 
INEQUALITIES 


This chapter presents a methodology by which aerodynamic surface sizes can be 
optimized using performance requirements which are posed as Linear Matrix Inequal- 
ities. Several examples are presented which demonstrate the utility and flexibility of 
the method. The MATLAB files which support the material of this chapter can be 


found in Appendix D. 


A. INTRODUCTION AND PROBLEM MOTIVATION 

The control design process for rigid body vehicles (air, marine and space) in- 
cludes not only the design of the control system itself, but also the refinement of the 
size of the control effectors. Generally, the shape and overall size of the vehicle is 
dictated by mission constraints such as payload, range, or maximum speed. Control 
effectors and stabilizing surfaces are then appended to the baseline vehicle to pro- 
vide sufficient control power so that, in concert with an appropriate control design, 
the desired dynamic performance is realized. Control power is very expensive, 
resulting in increased weight, drag, signature, and financial cost. Consequently, the 
configuration designer would like to incorporate only that amount of control power 
that. is necessary to attain the desired dynamic performance requirements. The ad- 
vance of controls technology in the past 25 years have led many commercial and 
military aircraft designers to consider reduced static stability aircraft as a means of 


improving performance and lowering cost. 
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The question spawned by this drive toward improved performance is consequently — 
how much control is enough? There are actually two facets to the question. First 
of all, flying qualities specifications must be identified, which, if satisfied will permit 
the vehicle to meet its mission requirements. Much of this field relies on the subjec- 
tive opinions of pools of research pilots and engineers. Flying qualities consequently 
translates mission requirements into dynamic performance requirements. Consider- 
able work has been invested by the military services and NASA in recent years to 
expand the traditional flying qualities standards [Ref. 1] to the new paradigm of 
relaxed static stability aircraft. The second facet of the problem is translating the 
flying qualities specifications into physical configurations and control systems. This 
question is addressed by this work. 

In aeronautical applications, control sizing is driven by several distinct environ- 
ments. Each of these must be independently considered in the design, and the most 


stringent adopted. The three principal environments are: 
e Take-off, Approach and Landing (terminal area flight); 
e High angle of attack flight; 
e Supersonic flight. 


Corresponding to each of these environments is a set of critical center-of-gravity (cg) 
locations. For each of these cg locations, sufficient control power must exist to provide 
the controls designer with the capacity to achieve appropriate dynamic performance 
(stability, maneuverability, and disturbance rejection) for both nominal and failure 
conditions. However, the nature of the control power required to provide such per- 
formance differs greatly from environment to environment. For example, in the case 


of supersonic flight, the principal issue is maneuverability. Here, control power can 
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be degraded by changes in the aircraft center of pressure or blanking of the control 
surfaces by shock-waves. Experience with supersonic flight has provided a base of 
knowledge for providing adequate control power in this environment. Since control 
power is basically proportional to the airspeed squared, it is more frequently crit- 
ical at the other extreme of the operating envelope, at slow speed, such as during 
high-angle-of-attack maneuvering and take-off/approach/landing. In the case of high 
angle-of-attack flight, the aerodynamics are very non-linear, and the concern is the 
ability to generate specific rates or accelerations (maneuverability). The specifications 
are therefore generally expressed as open-loop rates or accelerations. 

The specifications determining the control power requirements for slow speed 
terminal-area flight are both closed-loop and open-loop. In this environment, the 
concern of the configuration designer 1s to provide the controls designer with adequate 
control power such that a controller can be designed which satisfies the specified 
closed-loop flying qualities, as well as open-loop maneuverability. Unlike the other 
two environments, linear flight mechanics prevail, and the vehicle can reasonably be 
modeled as a linear system. A significant portion of the control sizing problem is 
consequently a linear controls problem. 

This chapter addresses the problem of simultaneous aircraft/controller opti- 
mization. As discussed in Chapter III, many closed-loop control problems and flying 
qualities specifications can be formulated as convex optimization problems, some of 
which can further be simplified into LMI’s. It has been our observation that for many 
rigid body systems, performance specifications which are posed as LMI’s provide a 
means for not only solving the controller design problem, but also directly determin- 
ing the upper-bound for the minimum necessary control power. As a result of the 
this work, the aircraft and control system designers will be provided with a new tool 


capable of answering the plant/controller optimization problem: 


Given the flying qualities requirements for a specified mission, find the 
minimum aerodynamic surface sizes, and a feedback controller, which to- 


gether satisfy mission requirements. 


The answers obtained are important to reduce aircraft weight, size, and ob- 
servability and would result in cost savings in many current and future aircraft pro- 
curement programs. The application of these methods is certainly not restricted to 
aeronautical applications, in that control power is expensive in all engineering sys- 
tems. In a chemical process system, the control power is reflected in the diameters of 
the pipes and tubing. The controls designer here is no less interested in minimizing 
the costs of achieving adequate control power. 

For aeronautical applications, the seminal work to date on this subject was a 
design guide published by the Grumman Corporation in support of NASA’s X-29 
program [Ref. 5]. The scope of that effort was significant, including non-linear aero- 
dynamics and flexible structures, issues which were beyond the scope of the material 
treated by this research. The authors acknowledged, however, that a limitation to 
their approach was the a priori choice of the structure of the controller. They sug- 
gested that optimization tools would be required in order to relax this constraint. The 
problem considered in [Ref. 5] is consequently a search over the set of plant config- 
urations that, in concert with the specified controller, yield the desired performance 
requirements. Recently developed computational tools (such as those presented in 
Chapter II) and the convex formulation of many powerful control problems now per- 
mit the consideration of the larger problem, where the designer is not restricted to a 
specified controller structure, but can instead examine the set of all controllers which 


satisfy the performance measures. 
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The sections that follow present a formulation and methodology for the opti- 
mization of an airframe using LMI’s to pose the design constraints. First, section 
B will define the problem. Then, in section C, a pure H,, constraint will be used 
to pose disturbance rejection requirments. A formulation will then be presented for 
the solution of the plant/controller optimization problem, and demonstrated by an 
example. The example problem will be a regulation problem in which there is no 
command tracking signal, but instead a controller which simply stabilizes the system 
and provides a specified disturbance attenuation. This section will also present how 
this formulation can be expanded to include diverse HH, specifications at multiple 
flight conditions. Next, in section D, both internal stability and disturbance rejection 
specifications will be considered. Section E will present several methodologies for 
formulating the various open-loop maneuverability requirements as LMI’s. The ex- 
amples in this section will demonstrate the application of open-loop maneuverability 
requirements. Next, section F presents a formulation for accommodating paramet- 
ric uncertainty in plant optimization process. In wrapping up, section G discusses 
the results, their limitations, and other applications, while section H discusses future 


directions for this research. 


B. PROBLEM DESCRIPTION 


Once again, the problem we sought to address in this research can be stated as 


follows: 


Given the flying qualities requirements for a specified mission, find the 
minimum aerodynamic surface sizes. and a feedback controller, which to- 


gether satisfy mission requirements. 


It will be shown that determining an upper-bound to the optimum answer to this 


problem can be reduced to minimizing a linear cost (a function of aircraft parameters) 


S| 


subject to matrix inequalities which represent the mission performance requirements. 
The problem formulation and proposed solutions are discussed next. 

Let ¢ be a vector of the aircraft parameters which we would like to optimize. 
furthermore, suppose the plant matrices A, B, and B2 can be expressed as affine 


functions of the plant parameters. In other words, let 


A 


A(¢) = Ao + 0 GAs, 


By = BC) = Biot ae. 


i=! 


By = BO)= be ee 


i=l 
Later examples will demonstrate that many plant parameters, such as the area of an 
aerodynamic control surface, naturally occur.as affine variables in a dynamic systems. 
Since ¢ represents physical sizes for the proposed problem, we constrain ¢; > 0. Let 
J = c'C be the cost function, where c; > 0 denotes the relative cost we choose to 
assign to each parameter ¢;. For example if we seek to minimize the total mass of the 
physical control surfaces, and ¢; were the physical area of each control surface, then 
c; might be the mass per unit area, and J the total weight of the subject components. 
Or c; could be selected to be the cost per unit area, in which case J is the total cost of 
adding surfaces under consideration. The linear cost functional J(¢) is clearly convex 
it ¢. While a linear combination of the optimization parameters is the easiest to 
accommodate, the general formulation proposed would permit any convex function 


of the optimization parameters. The general problem can now be stated as: 
Minimize: J = cl ¢, 
Subject to: F (creat: (5.1) 


where F'(¢,&) < 0 reflects all the relevant performance requirements. It was our desire 


to determine if these performance constraints could be posed in some manner that 
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would permit solution of the optimization problem by convex methods. In order to 
clo this, we considered the various types of constraints which typically arise in flight 
mechanics. 

The three general sets of performance criteria which drive control power re- 
quirements are stabilization, disturbance rejection, and maneuverability [Ref. 5]. 
Stabilization requirements pertain to the internal dynamics of the problem and are 
frequently posed as pole-placement requirements. Much of the concern relevant to 
control power optimization can be attributed to the trend towards vehicles with un- 
stable open-loop modes, and the acknowledgment that some portion of the control 
power would have to be devoted to providing closed-loop stability. Simple stabil- 
ity can be posed as either a Lyapunov inequality, or an #H. constraint. Chapter 
III described how a pole-placement requirement could be posed as convex matrix 
inequalities. 

The second type of requirement which influences the necessary control power 
is disturbance rejection requirements. These are usually posed as limitations on the 
rms output, as a consequence of a specified rms input. The disturbance attenua- 
tion specifications can be directly posed as 7H. constraints, which we know to be 
expressible as a matrix inequality. The inputs are generally meteorological gusts, 
represented by a model such as the Dryden turbulence model [Ref. 1]. The outputs 
iiclude both the physical response of the states and the closed-loop response of the 
actuators. The specification determines the first, while physical constraints, such as 
the actuator deflection limits and limit rates, define the limit acceptable values for 
the latter. The H., constraint is well suited to these types of performance measures 
due to its power gain interpretation, as described in Chapter II]. An H. constraint 
will not ensure that a peak actuator deflection can not exceed a given value, but it 


can limit the power signal of the actuators deflection and rate. 
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Maneuverability is the third performance measure which drives control power. 
The constraints here have the form that a specified output should exceed a given 
value when all relevant controllers are fully deflected in the appropriate direction. 
This is an “open-loop” requirement to a flying qualities engineer because the loop in 
which he is interested is open— the pilot’s command 1s saturated and the pilot is not 
trying to actively track some variable. This need not imply that the loops within the 
controller are “open”, and a controls engineer may use either an open or closed-loop 
formulation. 

Maneuverability requirements can actually have several forms. In the sizing of 
a rudder, for example, it may be a requirement that the minimum moment must 
exceed that required to balance an engine out condition. In this case, static control 
power is the issue. As will be shown later, this can directly be expressed as an 
LMI. In other applications, the specification may require that the system exhibit 
a minimum body rate in response to a limit command input. Since most of our 
controllers produce either moments or accelerations, then a specified steady state 
rate represents the output of a dynamic system. These types of specifications can 
consequently be referred to as dynamic maneuverability requirements or dynamic 
open-loop requirements. These too we will show to be expressible as LMI’s. 

In sum, control power requirements are determined by the joint requirements of 
closed-loop internal stability, closed-loop disturbance rejection, and open-loop maneu- 
verability. Each of these performance constraints can be posed as matrix inequalities. 
The joint imposition of many such matrix inequalities provides a mechanism for solv- 


ing the subject optimization problem. 


C. APPLYING DISTURBANCE REJECTION REQUIREMENTS 

In this section we will formulate the plant/controller optimization problem, 
using an H, specification as the design constraint to apply disturbance rejection 
requirements, as well as simple closed-loop stability. Recall equation 3.13, which 


poses the H, performance constraint as a LMI: 


RAW.Y) := AY +YA'+ BW+W'BL4+ B, Bo (CY + DW) 
a (CY + DW) —y1 


< 0, (0:2) 
Assume that the inputs and outputs are scaled such that y = 1, and consider € to be 
the vector of the controller parameters such that W’ and Y are affine functions of € and 
Pacaamatrices ¥,, Wy: y = ¥ (€) = lo +d 2, 6), and W = W(é) = Wot 1 GY, 
EER and s = (n(n + 1)/2) + nq. First, using Schur complements, equation 3.13 is 
equivalent to the following LMI: 


. Oe eA tee Weta ae es eee llals ue 
fo(¢. ) = : BI ( yi Zz ag. |B 


Note that thrs constraint is affine in the plant matrices A, B; and Bo. 


Optimization problem 5.1 can now be exressed as: 


Minimize J = c?¢ 


DUD |ectntOe) 0 > OTC .c) <0, (5.4) 


where F;(¢,&) is given by either Ry or Rz (equations 5.3 and 5.2). Recall, both con- 
straints are equivalent. To simplify notation, the dependence of the matrix functions 
on ¢ and € will be implicit in the sequel. The controller matrices (¥, W) will consis- 
tently be functions of € and the plant matrices (A, B;, Bz) will always be functions 
o) 

As can be seen in equation 5.3, this problem is affine in C for a fixed controller 


IX = WY7!, since the plant itself is affine in ¢. On the other hand, equation 5.2 
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shows that for a fixed plant (A, B,, B2,C, D) this problem its affine in € . Our problem, 
however, is to minimize J over all feasible ¢ and €. Even though J is affine in ¢, it 
is not clear whether the constraint set {®@ = (¢.€) : ¢ > 0, R(C,E&) < 0} 1s convex. 
This means that the numerical solution of the optimization problem 5.4 may turn out 
to be a local minimum. An important area of future research will be to determine 
whether the set ® is convex. Presently it can be shown that for a special case of 
the optimization problem 5.4, the set ® is convex. This case is discussed in the next 
section. 

1. Special Case: Plant/Controller Optimization as a Generalized 

Eigenvalue Problem 


Consider a single parameter plant optimization problem, where 


A = Ao + CA}, 
B, = Digs 
Bo = Bo, + ¢ Bo,. (5.5) 


Suppose the matrix pair (A;, B2,) is stabilizable. A physical example of such an one 
parameter problem could be optimization of the size of the vertical tail of an aircraft, 
or the size of the control fin on a missile or a submersible. Now the optimization 


problem can be formulated as follows: 
Minimize : ¢ 


Subject to: F¥ > 0, ¢ > 0, and 
AoY + YAp> + BoW + WB, + BB+ : a 
ee ( (ALY + YA) + Bo, W + W'BS ) atts. 
(CY + DW) —[ 


<UE 


(5.6) 


Let « denote a very small number. Using simple algebra and the definition of nega- 


tive definiteness, it can be shown that optimization problem 5.6 is equivalent to the 
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following problem: 
Minimize :¢ 


Subject to: Y > 0, ¢ > 0, and 


_| -(ALY + YA), 4+ Bo,W4+W'B, ) 0 
C ] 
¢ el 


7 | Aer eA eal ei eae a Cy DIY | ae) 2 


(CY + DW) _] 2a) 


Problem 5.7 is in the form of the Generalized Eigenvalue Problem (GEVP) (see 2.1 


and [Ref. 15]): 


Minimize: A 
Bubiect to: Avgiay) =A ee OAT) SA) lr) > OC (rr) 0. 


where A(x), B(x), and C(x) are affine in x. As mentionned in Chapter II, the GEVP 
is a quasi-convex problem, meaning that it has a unique global minimum which can 
be found using efficient numerical techniques {Ref. 14, 15]. 
2. General Case 

Unfortunately, many of the more interesting aircraft optimization problems 
cannot be reduced to GEVP form. This is particularly true for the case where several 
aircraft parameters have to be optimized. However, the optimization problem 5.4 is 
affine in either the vector of plant parameters ¢, or the set of controller parameters 
W and Y. This suggests the following approach to solving the optimization problem 
5.4: find a controller (holding the plant constant) , and then minimize the objective 


function while holding the controller constant: 
Peieix A(¢), B(¢). Phen, 


Minimize: A (over &), 


¥(o) 0 


Subject to: Oe Bui ec |) 


0 (5. 


CN 
2 
~~” 


\o 2) 
~] 


2. Fix W (Goay (6 \aadalvem: 


Minimize: J (over ©), 


cic 0 0 
Subject to: 0 diag(C) 0 a): (5.9) 
0 0 ge GS) 


3. Go to step | until exit criteria is satisfied. 


Denote the value of A obtained in the first step as the controller margin. 
Given the controller determined in the first step, the second step of the procedure 
then finds the feasible plant with the smallest associated cost. The procedure quits 
when the controller margin becomes so small that the numerical procedure either fails 
to find a new feasible controller after step two, or step two is numerically unable to 
further refine the plant. | 

The controller margin has a very rich, significant geometrical meaning. As 
the maximum eigenvalue of f,(¢,&), the controller margin presents the “distance” 
of R,(¢,£) from singularity, and consequently the “distance” or margin by which 
the closed-loop system satisfies the performance specifications. It could notionally 
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be considered to represent the “size” of the set of feasible controllers. The set of 
feasible controllers is either empty or infinite, so “size” is used loosely. The greater 
the margin, however, the greater the range of feasible controllers. This is important 
because the further that /t,(¢,&) is from singularity. then the more “room” available 
for the second phase of the algorithm to optinize the plant. One would intuitively 
expect that as the controller margin decreases, then the amount of latitude available 
to optimize the plant also decreases. 

Note that both steps of this algorithm are EVP’s and consequently perfectly 


suited for solution by interior point methods. Since the problem is affine in both 


steps of the algorithm, the numerical procedure is guaranteed to converge. But, as 


Cm 
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discussed earlier, whether the problem is convex jointly in the controller and plant 
paraineters is presently not known and is subject of future research. ‘Therefore, there 
is no assurance that the obtained minimum is global (unless the problem satisfies the 
conditions of the special case). The above procedure clearly determines a valid upper 
bound for the joint procedure, since a solution by interior point methods would never 
leave the joint feasible set. We have not, however, established a means for computing 
a lower-bound. This too is an issue to be pursued by further research. 

A sequence of examples will demonstrate the viability of the proposed 
methodology and illustrate several of its more powerful implications. For the first 
several examples, a single plant variable is optimized. The examples build in complex- 
ity as the methodology is expanded to accommodate the other various performance 


Wmeasures. 


EKrample One- Optimal Vertical Tail at a Single Flight Condition 


This very simple example will demonstrate the formulation of the problem, 
as well as some of the properties that were discussed above. Consider the directional 
dynamics of a typical fighter-size aircraft. The most simple approximation is a second 
order system, with aerodynamics providing both restorative and dissipative forces. 
The wing-body combination of most aircraft is sized and shaped by factors such as 
range, maximum speed, payload. powerplant. Typically, the directional dynamics 
of the wing-body combination include both a stable and an unstable pole. Given a 
specific wing-body combination, the problem for the aero configuration designer and 
control designer is to determine tlie size of the vertical tail and controller, which, 
together in feedback, provide satisfactory dynamic behavior. For simplicity, we'll 


consider an all-moving tail so as to reduce the number of degrees of design freedom 
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to one. Because of the single degree of freedom, this problem is quasi-convex and is 
know a prior? to have a unique, global minima. 


The governing differential equation 1s: 





a Ye ‘ 
p = Oe 7% eh ar es 7 Car : (5.10) 
The notation here is standard aeronautical usage: 
w  := disturbance input 
6  := control deflection 
2  := sideslip angle 
q := dynamic pressure 
S  := wing reference area 
b := wing span 
I,  := moment of inertia about the vertical (z) axis 
l, := vertical tail lever arm (distance from CG to aero center of tail) 
Cy, %= non-dimensional change in yawing moment per radian of sideslip 
V  := aircraft velocity 
(5.11) 


The contribution of the tail and wing/body can be separated: 


OF. = Camm + Cig, V (Sale) 


where V = At is defined as the vertical tail volume. Note that VY is a dimensionless, 


affine function of the vertical tail area A; (or /;!). This is the quantity which we shall 


optimize. Using 5.12, 5.10 can be rewritten as follows: 


[|=] 8] + Bao + me (5.13) 


where: 
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I, I; 
Bs = Bo,, + By,V 
0 0 
= + qSbliC; Y (5.16) 
0 ——— 
: 2qSbliCy 
Note that for this problem, A; has eigenvalues at zero and = (Cy, > 0). 


The following numerical values were obtained using stability derivative data 
from (Ref. 37] and [Ref. 40] for a fighter aircraft at a flight condition of 230 fps at 


sealevel. 


ron 0 1 |, 0 0 
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The tail volume VY was initialized at a value of 0.47. 
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The problem was to determine the ninimum tail volume which together 
with the feedback controller would stabilize the plant, and would limit the rms ac- 
tuator deflection and sideslip to ten and two degrees, respectively, in the presence 
of moderate turbulence. MIL-8785C establishes moderate turbulence as 10 fps at 
sealevel. B, 1s scaled by a factor of 10 fps/230fps to normalize the rms value of w to 


1 radian. Since the outputs of interest are 3 and 6, the synthesis model is completed 


en eo csv aa 23 0 7 
=| 8 ]-| 0 ES] +t sca [4 and 


The output signals have likewise been scaled to guarantee that an rms output of | 


by: 


rad satisfies the performance requirements. 
An interior point method was used to perform the optimization problem 


of posed by algorithm 5.8 and 5.9 to determine: (a) the smallest vertical tail vol- 
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Figure 5.1: Optimization History for Tail Volume (Example One) 


ume, and (b) the associated state-feedback controller which satisfied the performance 
requirements. Recall that the design of a controller which satisfies an H,, bound 
implicitly satisfies internal stability. The final required tail volume was Y = 0.0250, 
and the associated controller was A = [5.443 10.467]. 

Figure 5.1 depicts the progress of the optimization algorithm, with the 
algorithm commencing in the top right corner. Note that the cost and the controller 
margin decreased monotonically with each iteration. For a single variable problem, 
the weight was set to one, so that the plant cost was identically equal to the tail 
volume. The algorithm forces the cost to decrease monotonically since the terminal 
cost at the end of each step is then the starting cost for the commencement of the 
next iteration. For a single plant variable, the controller margin would be expected 
to decrease monotonically, since the margin reflects the size of the set of feasible 
controllers. Since A,» was not stable, then the open-loop poles predictably moved to 
the right as Y was decreased. Consequently, as the poles of the open-loop plant shifted 


to the right, the set of feasible controllers would be expected to monotonically shrink 
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as well (this was not true for multi-variable problems, as will be shown later). ‘The 
process was terminated when tle numerical routines either 1) could not find a feasible 
controller during step 1; or 2) the controller margin exiting step 2 was too small to 
numerically permit further refinement of the plant. In this particular example, the 
graph clearly depicts the minimum bound achievable by this method. 

This example clearly demonstrated the viability of the general method. It 
was, however, limited in its applicability, since it only provided the size of the tail 
volume required at a single point in the operating environment, and the fulfillment 
of a single performance criteria. The challenge for the configuration designer is the 
determination of the optimal plant which satishes diverse performance requirements 
at all points within the operating envelope. The next section will show how the 
method easily expands to accommodate additional constraints. 

3. Plant/Controller Optimization with Multiple Joint HH, Con- 
straints 

Consider now the problem of finding the optimum size of the vertical tail 
which will satisfy three different 7. performance requirements at distinct flight 
conditions. Many of the plant variables in equation 5.16 are dependent on the flight 
condition, including the moment of inertia, the dynamic pressure and the stability 
derivatives. The plant matrices may consequently be dramatically different. Let 
G 1(C), G 2(C), and G ,(C) represent the aircraft dynamics of a single configuration, 
but at three separate flight conditions. Let €, é and é represent the controllers that 
satisfy the three distinct H. performance requirements represented by 2y(C¢,&) < 0; 
Ro(C.€) <0; and R3(C,£) < 0. These three independent H,, requirements will be 


satisfied if : 


0 0 
R(¢,€,€,€) = OPC ey 0 0: (5.18) 
0 ( 


93 


The optimization problem can therefore be formulated as follows: 


Minimize: J = eC, 


Subject to: R(C,E,€,€) < 0, C>0. 


This problem is affine in the plant variable ¢ for fixed controllers, and affine in the 
controller variables ,€, and € for a fixed plant. The solution to this problem is the op- 
timal plant which permits satisfaction of each of the three performance requirements, 
and each of the three associated controllers. The problem strategy is similar to that 
pursued above with only minor modification. Since the three controller solutions are 
independent, they can be determined independently to save computational cost, with 


the plants fixed. 
Exvample Two- Optimal Vertical Tail at Multiple Flight Conditions 


To demonstrate the multiple flight condition problem, the following three 
flight conditions were chosen for the aircraft in the Example 1: 230 fps at sealevel, 
S76 fps at 35 A ft, and 1742 fps at 55 AW ft. These conditions correspond to the 
approach, subsonic cruise, and supersonic dash mission phases. Models were again 
synthesized from [Ref. 37] and [Ref. 40]. The horizontal gust magnitude was 10 
fps at sealevel, and 5 fps at the other two conditions. Identical constraints on the 
performance outputs were imposed (2 degrees of rms sideslip and 10 degrees of rms 
tail deflection). 

Figure 5.2 depicts the progress of the algorithm. Note that one flight 
condition dominates the process, and the algorithm quits when the controller margin 
is exhausted at the slow speed flight condition. Intuition is confirmed in that for 
a single variable problem, one would expect the limiting tail volume to be identical 


to the greatest of the three tail volumes when calculated independently. The three 
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Figure 5.2: Optimization History Multiple Flight Conditions (Example 
Two) 

resulting controllers were: Ngsiou, = [5.443 10.467]. Noeubsonre = [31.396 33.350], and 
IN supersonic = [38.647 37.949]. This single procedure therefore results in an optimal 
plant configuration and the necessary controller for each operating point. 

The physical structure of our methodology thereby accommodates the sim- 
ple inclusion of multiple plant operating conditions by direct diagonal augmentation 
of the constraint matrix functional. The number of flight conditions is limited only 
by one’s patience in waiting for the computational outcome, and the ability of the 


uumerical routines to find viable answers. 


D. APPLYING JOINT DISTURBANCE REJECTION/ STABILIZA- 
TION REQUIREMENTS 
Now consider a problem in which the disturbance rejection requirement is im- 
posed, along with a requirement that the closed-loop poles be placed in a specified 
circle. The H., norm will again be used to impose the disturbance rejection require- 


ment. Note that minimizing the control power subject to a pole-placement require- 
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ment is not by itself an interesting problem. Intuitively, some constraint on actuator 
activity 1s mandatory in the problem formulation. Otherwise, the solution would 
sunply allow actuator activity (represented by the state-feedback gain) to increase in 
ai unbounded fashion to compensate for the decrease in control power. 

Let a and r define a circle of radius r centered at g = —(a+r). As discussed in 
Chapter III, the poles of (A + Bj!) are in the circle defined by a and r, if and only 
if there exists a positive definite solution ¥ = Y! > 0 such that the following matrix 


inequality is satisfied: 


5(¢,6) < 0 (5.19) 
where, 
S(C.€) = (A+ Balk padi 2 Ae eae 
Oe SAN Tare OGe PANES [8b] etswee ee (5.20) 
Using the substitution A = WY7!, this expression is equivalent to both of the 


following matrix inequalities, by Schur complements: 


51(¢.€) = 
(Atal)Y¥+¥(Atal)’ +(A+al)(Y¥/r)(A 4+ al)?+ BW 
BoW((A + al)/r + 1)" + ((A+al)/r + IW BI ; << (I 
(BW)? -Yr 
(aaa) 
and 
SC, €) i= (A+ BK +al)y V(AS BK pa) See eee , 
220; oe (A+ BK +al)? —inv(Y/r) 


(5.22) 
The $1(¢, €) is affine in €, and S2(C¢, €) is affine in ¢, but neither is affine in both. Since 
the two expressions are equivalent we can alternatively use them for the controller 


design and the plant optimization. The mechanics of constraining the problem to 
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simultaneously satisfying both the pole placement requirement and the H., bound, is 
analogous to the multiple flight condition problem described previously. The problem 


can be stated as: 


Minimize: J =c’¢ 


andor 0): (3.235 


SUbIECh [O. fice) — | a es é) 





Here, we again employ our prior approach of dividing the problem into two LMI 


sub-problems. Define two matrix inequalities: 











Fy (¢, €) 0 
T1(¢.€) = oe —G 5.24 
(C.€) | arr (5.24) 
Fi2(C, §) 0 
Tote. 2 |= . —) o23 
We now propose the following algorithm: 
1. With C fixed, 
Minimize: A, (over &) 
Subject to: | a . mn : = : 
2. With optimal € from step 1, 
Minimize: J. (over C) 
5 et 0 0 
Subject to: 0 diag(¢) 0 So. 
0 0 —T, 


3. I[terate until termination criteria satished. 


Due to the affine problem formulation, both steps may be solved by either inte- 
rior point or convex methods. The H,, constraint and the pole placement constraint 


are just two examples of constraints that can be expressed as LMI’s. Consequently, 


of 


this method of diagonally augmenting constraints to achieve a joint constraint can 
be used with as many jointly feasible diverse constraints as desired. Examples might 
include the intersection of several circles, or distinct H,, H.. bounds. We will 
later formulate the H,. /H. problem in providing for distinct #{,, bounds on 


robustness and on performance. 


Example Three— Vertical Tail Optimization with Joint Constraints (H. and Pole 


Placement) 


Consider again the single flight condition problem from example 1, retaining the 
disturbance-to-output performance criteria. MIL-8785C requires that the closed-loop 
dutch-roll frequency exceed 1 rad/sec and that the damping ratio exceed 0.15. These 
requirements can be (conservatively ) satisfied by constraining the poles to a circle of 
radius 87.3, and centered at (-88.3,0). By jointly posing these constraints using the 
above formulation, the plant optimization problem was solved using interior point 
methods. The resulting optimal tail volume was V = 0.0383, with an associated 
controller AK = [15.96 18.91]. The resulting poles were at —1.500 + 0.6377 (inside 
the circle). Figure 5.3 depicts the progress of the algorithm. Note that the addition 
of the pole placement constraint required a larger tail volume than was achieved in 
Example 1 for the #,, constraint alone, where VY = 0.0253 was required. 

A significant attribute of this problem is that unlike the previous two, this 
example (or any problem with joint constraints) could not have been be solved by 
bisection on ¢ and a standard Riccati based #H,. controller design. We have now 
demonstrated how the methodology accomodates both stabilization and disturbance 
rejection specifications. Next, we will demonstrate the inclusion of open-loop maneu- 


verability specifications into the problem methodology. 
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Figure 5.3: Optimization History for Joint H,, / Pole-Placement (Exam- 
ple Three) 


E. INCLUDING MANEUVERABILITY REQUIREMENTS 


This section presents several methodologies by which open-loop maneuverabil- 
ity requirements can be expressed as LMI’s. Maneuverability requirements are very 
much unlike disturbance rejection, where the closed-loop plant must demonstrate a 
maximum acceptable level of attenuation in the presence of disturbances. Instead, 
maneuverability requirements demand that a system demonstrate a minimum ampli- 
fication in the presence of a command signal. Consider the open-loop system depicted 
by Figure 5.4. A typical maneuverability specification has the following form: given 
a maximum control input u = Umar, the steady state response of a scalar output r 
must exceed a certain threshold, rinres . Note that u may be a vector of all relevant 
control surfaces. 

Alternatively, consider the closed-loop system of Figure 5.5. The maneuver- 
ability specifications above could equivalently be expressed in the context of this 


closed-loop system: Given an input reference signal Tema of magnitude Tihres, the out- 


ug 


Figure 5.4: Open-loop Formulation for Maneuverability Constraints. 


yi # Verror 
= A 2 = 
cm u 


Figure 5.5: Closed-Loop Formulation for Maneuverability Constraints. 


put Verror = —Tema must be zero in steady state, and the control inputs u; must not 
exceed Umax, in steady state. 

Maneuvering specifications fall into two general classes, for which each of these 
formulations are helpful in posing the requirements as LMI’s. As examples, consider 
two different longitudinal maneuverability specifications for a tactical aircraft with 
canards, stabilators and thrust vectoring . longitudinal control effectors. In the 
first case, sufficient control power might be required to provide at least 9 g’s at a 
specific flight condition, with all effectors fully deflected or deflected no further than 
some effective limit (aerodynamic surfaces may lose effectiveness long before reaching 
a physical actuator limit). Alternatively, a requirement might be that the sum of 
the effectors generate a pitch acceleration of at least 0.25 rad/s at full deflection at 
a specified flight condition. Both of these types of design specifications exist. The 


output rin either case would be scalar, while the input uw would be a vector of the 
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three control effectors. 
To understand the difference between these two types specifications, consider 
the state space representation of the open-loop system depicted by Figure 5.4: 


r = A(C)at+ Boa(C)u 
C(cla =p DiC hi 4°. (5,20) 


* — ~ 
7 — = 


qn) 
| 
t? 
[| 


Let Topen denote the transfer matrix from u to r in Figure 5.4. Then it has the 


following form: 


Topen : (8) = {C(6)(sl — A(C))7"Ba(C) + D(C)} u(s). (5.27) 


For the examples we cited above. if ris the pitch acceleration, then D is non-zero, and 
C’ is zero, annulling the first term of the transfer function matrix. On the other hand, 
if r is the load factor, then the D matrix of the above open-loop system ts zero. The 
first. case can be considered a static maneuverability specification, while the second 
one a dynamic maneuverability specification. We will see that a static maneuverability 
requirement is easily posed as an LMI. In the case of dynamic specifications, however. 
both the closed-loop and open-loop formulations can be useful. 
1. Static Maneuverability Requirements 

First, let us consider the static maneuverability requirements. These in- 

clude constraints where the modeled open-loop system has a non-zero D and zero C 


matrices. An LMI formulation for the requirement is evident by inspection: 
| OL UG Vier re eet ry ere. 0 (5.23) 


Multiple similar requirements could be diagonally stacked. This type of specifica- 
tion can also referred to a static control power constraint, because it frequently is 
expressed as the static moment required from a controller or set of controllers at a 


specified condition. These conditions can either be equilibrium or non-equilibrium. 
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The specification itself can have units of force or moment, or translational or an- 
gular acceleration in response to a limit control deflection. The next example will 
demonstrate how specifications of this type can simply be accommodated by our 


inethodology. 
Evample Four- Vertical Tail Optimization with Static Moment Requirements 


A specification that frequently sizes vertical control surfaces is the require- 
ment that adequate control power be available to balance the moments generated 
by adverse thrust conditions, such as engine out. Consider the vertical tail sizing 
problem discussed above. In addition to the previous H,, specification for turbu- 
lence rejection and stabilization, let us now also impose the static requirement that 
the tail be sized so as to be able to generate a moment adequate to balance 40,000 
ft — lb of torque at full deflection (30 degrees) at our nominal flight condition. This 
requirement is representative of the torque necessary to balance an asymmetric thrust 


condition. Furthermore, it can simply be posed as the following LMI: 
Driatie\ V ) =e eV ee ene (5.29) 


where ties = O02 ad sang tre 4 0 000 iim 
Let € = V. Since the constraint Dytaic(E) > 0 is not relevant to the 
search for a feasible feedback controller, it does not need to be considered during the 
controller optimization phase of the process. Therefore, the algorithm can now be 
posed as follows: 
[With ¢ lxede 
Minimize: A, (over €) 
Subject to: | al e ee 4 | zal): 
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2. With optimal € from step 1. 


Minimize: J, (over C) 


yer en 0 0 0 
; 0 diag(¢) 0 0 
b 
Subject to 0 0 oi 0 ale 
0 0 0 Dstatie(¢) 


3. Iterate until termination criteria satisfied. 


Figure 5.6 depicts the progress of the algorithm, with the starting point at 
the upper-right end of the trace. This graph depicts two significant issues. First of 
all, the final required value was VY = 0.14, rather than the value of 0.025 which was 
required when the 7. constraint alone was applied. This answer is in fact identical 


to that obtained if we had alternatively solved the linear equation: 
Govt — lthres = 0. 


secondly, the controller margin at the conclusion of the optimization is several orders 
of magnitude greater than that for any of the previous problems. This indicates 
that the set of feasible controllers is comparatively large, and that the final answer 
was independent of closed-loop dynamic issues and was instead driven by the open- 
loop maneuverability requirement. This is consistent with the industry’s practical 
experience that directional control power is generally sized by considerations such as 
thrust asymmetry rather than turbulence rejection. 

The kink in the plot for the joint specification is caused by the nature of 
the graph. The x-axis reflects the result of the controller optimization phase of the 
algorithm, while the y-axis reflects the result of the plant optimiztion. The static 
maneuverability constraint is only applied during the latter phase, and so when the 


static constraint boundary is reached, the controller phase finds a new controller with 
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Figure 5.6: Optimization History for Vertical Tail Volume with Static 
Constraint (Example Four) 
a smaller control margin, but the plant optimization phase can not decrease the plant 
cost any further. The result is an abrupt kink in the plot. 
We have consequently demonstrated how static maneuverability specifica- 
tions can be accommodated into the methodology. 
2. Dynamic Maneuverability Requirements 
Now consider the problem of posing dynamic maneuverability specifica- 
tions, where for the open-loop system D = 0, and C is a rank one row vector. As 
mentionned above, these types of requirements can be posed either in an open-loop 
or closed-loop formulations. 
a. Dynamic Maneuverability Requirements: Closed-Loop For- 
mulation 
We will first show how a maneuverability specification can be posed as 
an LMI by means of the closed-loop formulation. Let Ty,,..(G .C ) represent the closed 


loop transfer function from exogeneous disturbance w = r to the contro] command 
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u,. Here we are interested in the steady state response of the control command u; to 
the constant disturbance input w = Ttpres. In particular, absolute value of u; must 


not exceed umar, in the presence of t = rppres: 


u;(s) be Umar, 





(5.30) 


s=o threes 
Two approaches were considered for formulating this constraint as an LMI. 
(1) An #H,. Approach 
First, using the power interpretation of the HH. norm for a sta- 
ble SISO system, this requirement can be rewritten as a constraint on the H. norm 
mite ,C ): 


EAS) | Mee COp eG eats eee (5.31) 


ws) | 6 Tthres 











Notice, if the #,, norm of 7,,.(G .C ) occurs at a frequency other than zero, the 
constraint 5.31 provides only a sufficient condition for meeting the requirement. 5.30. 
However, it has been our experience that for the class of problems involving integral 
control, the H,, norm of Ty..(G .C ) occurs at the origin. 

Consequently, the H. specification previously applied for dis- 
turbance rejection can now be also applied to meet dynamic maneuverability require- 
ments. Depending on the problem, these requirements must be satished at the same 
flight condition as the disturbance rejection requirements (by including the command 
signal in the exogenous input vector w), or at a different more critical for maneuver- 


ability condition. 


Example Five— Optimization of Multiple Surfaces with Open and Closed-Loop Perfor- 


mance Requirements 


This example problem has several objectives. T*irst of all, it is 


a problem where the cost function is dependent upon multiple plant parameters and 
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thus provides a much more rigorous test of the proposed methodology. Secondly, a 
multiple variable problem permits using a variety of the initial values for the plant pa- 
rameters. This will help determine whether the algorithm will terminate at different 
answers, perhaps giving some insight into the convexity of the multiparameter prob- 
lem. Recall, the problem is convex in the single parameter case. Finally, a problem 
was needed with both open and closed-loop performance requirements. 

Because of the availability of component stability derivative data 
for the F-14 aircraft, a longitudinal control problem similar to the one in Chapter IV 
was selected. The vehicle parameters to be optimized were the normalized control 
powers of both the horizontal stabilators, and the direct lift control (DLC). Conse- 
quently, let the vector of plant parameters ¢ be defined as: 
fe 


(ae Cian Olas 


¢ = [a, Co] =a Cis ’ Cie 


nominal nominal 


The cost function weights on the plant parameters were arbitrarily chosen to be 
c= [3, 1]7. Recall, these weights can represent normalized cost in dollars, weight 
in pounds, etc. The reference input of interest was commanded flight path angle 7, 
and the outputs to be regulated were the actuator deflections, the angle of attack 
error, aud the flight path angle error. The disturbance input was a vertical gust. The 
control inputs were stabilators and DLC deflection (thrust was assumed constant), 
and the full state vector was assumed to be available for feedback. Thus, the problem 


was stated as: 


Find the plant parameters (C) and a state-feedback controller (€) which 
minimize the total cost J = c’C¢ of the longitudinal control effectors, 


subject to the following dynamic requirements: 


e Step response— The controller must track a step flight path angle 


command, Yemd, With no steady state error in a or jy. 
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e Closed-loop stability— The closed-loop system must be stable. 


e Closed-loop performance In the presence of a vertical gust distur- 
bance, Wgust, With a magnitude of 5 fps, the stabilator deflection 
should not exceed 20 degrees, the DLC deflection should not exceed 
40 degrees, and the angle-of-attack error should not exceed 1.5 de- 


grees (all quantities rms). 


e Open-Loop maneuverability— The plant must be able to generate a 
flight path angle (y = 0—a) of 3 degrees with the DLC and stabilator 


deflected no more than 40 degrees and 20 degrees, respectively. 


These requirements can be satisfied by the joint imposition of 


the following #{,, constraints: 


1. The step response requirement will be satisfied if and only if 





(T'esreng(G »C Ilo < 00, where 2, := [———, fener 
s ‘ 


te 


. The closed-loop performance will be satisfied if and only if 


Ostet dbDLC Oo 
20 deg’ 40 deg’ 1.5 deg 





l 
| ee (ORS | Mie where 22 := 


3. The open-loop maneuverability requirement will be satisfied if 








6steb ODLC \" 


| eG Re : 20 deg’ 40 deg 


, where 23 := | 


] 
3 deg 


A sufficient condition then for the satisfaction of these three constraints 1s the single 


constraint: ||73.(G ,C jlo < 1, where 


Pic . sa 
wos eee. yeaa = [5 Ips, 3 deg] 
> ots [Pstab Cee eerece Yerror |T 
PE —_ 20 deg’ 40 deg tes deg? Cc) Ss ‘ ey I : 
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and cy and cg are any finite positive numbers. This constraint also implicitly guaran- 
tees internal stability. This constraint later leads to the formulation of the synthesis 
model. 

The choice of optimization parameters was driven by the unusual 
character of the Direct Lift Control. This is significant because the DLC control 
power is neither linear in deflection nor proportional to the size of the DLC surfaces. 
Consequently, we must optimize a metric whose influence on the plant dynamics is 
linear. Normalized control power was therefore chosen as the optimization parameter 
in order to adhere to the assumption that the plant dynamics be reasonably modeled 
by a linear system. In the actual aircraft implementation, the controller will have to 
include a nonlinear schedule on the DLC deflection in order to achieve the commanded 
control power. Since the stabilators are a couentional aerodynamic surface, their 
control power is in fact linear with both deflection and surface area, and any one of 
several optimization parameters could have been chosen (tail volume, surface area, or 
absolute control power). To facilitate the comparison, normalized control power was 
chosen. 

To proceed with the problem description we need to define the 


following terms using flight dynamics conventions: 


a aircraft velocity resolved in the body z-axis 
eo T= angle of attack 
a — pitch rate about body y-axis 
CS pitch attitude 
a = non-dimensional trimmed force/moment coefficient, 
where X is lift (1), drag (D) or pitching moment (1) 
Cy, i= a non-dimensional stability derivative, 


where y £ ¢t is a nondimensional state or control deflection 
Om. = dynamic pressure 
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2 wing reference area 
— wing mean chord 


ee, = mass 
a. = moment of inertia about the lateral (y) axis 
a aircraft velocity 
Oe. = bata turbulence variance 
Gee b= maximum flight path angle command amplitude 
ea — ats stabilator lever arm (distance from CG to aero center of stab) 
a 


Next. the aircraft stability derivatives were expressed as the sum of their wing/body 


(wb), stabilator (stab), and DLC contributions [Ref. 40]: 


Co,,, °*= Cb, (5232) 
Cree One Grae (5.33) 
Gg et = Ce a Cra (5.34) 
Chap, fo ne tah ae (5335) 
Cy ON Sa Coe (5.36) 
CL, 3= Cr, +2 lie Cra (5.37) 
Gee Cs Od ee Tee (5.38) 


Note that since the DLC perturbs the nominal flow field, it has no contribution to the 

A matrix, but instead represents raw control power, influencing only the B matrix. 
The linear aerodynamic model of F-14 is derived next, followed 

by an outline of how it was used to form a synthesis model. The state derivatives 


of the core aerodynamic plant were r = [wu a gq 6)’. Let T be a rotation/scaling 


matrix: 
—cos(a9)  sin(ag) 0 
T :=QS | —sin(ago) —cos(ag) 0 |, 
0) () C 


where ag is the trimmed value of a. 
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Let J,, represent the inertia/ @ matrix. Then 


mV 0 O QO 0 

na mV = =a il 0 Cr, 0 0 
aie |e 0 Cm, 0 0 
| () 0 0 0 


Now, the state matrices of the plant have the following form: 


aoe — are a Te C1 ar VaR: 


2C' p, + Cp,V~ Cpe _ Cr. 0 
T MO + ‘Cel Cre, Tr Cr A - 


—mqg cos( 8) 


2Cm, + Cu.V~ Cm CM. .30 
t u Awb u Gees 6 
= 0 0 -—mV sin(ao) — 0) 
0 0 mV cos(ag) 
0 0 0 / 
0 0 i 0 
0 QO ay 0 0 0 0 0 
C FP || A I ee 0 00 0 0 
—] Lstab \ S % 
0 0 0) 0 0 0 0 O 
(5.39) 
leper = ao Saree ae Beg at eee G2 
0 O 0 0 
_ 0 0 ea eae es l 0 . 
= |0 0 |* = Seto i) 
0 O 0 0 
0 Cope Gare 
| oa Cie 0 ] es 
i 0 Coane) Cine 
0 O 
(5.40) 


Note that these matrices include dynamic coupling and gravity terms, as well as 


the aerodynamic forces. This model was verified by comparison with the nominal 
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state matrices (C = [1, 1]7) obtained from the linearization of the nonlinear model 
described in Chapter IV. 
Using the aerodynamic plant matrices above, a synthesis model 


G was formed: 


en rt = Art Bw Bou 
Fe 


with w and z defined above, and and 














0 0 0 0 
aera : : An : : 
me Hep OS 20 Sits evi 
2 0 0 Dern Oe ee 
jm LNG, 006 GUOS0 Les 20% 0 
1 ae ee eet (i006) SO a0 
0 0 
0 0 
OWA ercn 0 ow, Ce eA 0 
—_ i} 
B, 0 =e 0 ¢) (5.42) 
0 0 0 0 
l 0 ex fl 0 0 | 
sree 1D ene 
Ee = OPROreem ae wa 0G. (5.43) 
0 0 0 0 
ie Leger 10 ( 0 
0 0 90 0 0 
Se ere 0 (5.44) 
Gome0 “Ole. 2000001 0 
0 SOel0 0 0.0000! 
UU 0 
“0. , 
Da. = 0 Nahe sule (5.45) 
0 0 
L 0 J 


Note, the second column of A shows up in B, because the plant 
sees a sharp edged perturbation in the vertical airmass (6w) as a perturbation in 


angle of attack (6a = édw/V). (Here A(:,2) represents the second column of A). 


It] 


Note that the elements of w were scaled by 0; to achieve {|wll2 < 1. As a result, 
the synthesis model was scaled to ensure that any state-feedback controller C = h 
satisfying ||Tzu(G ,C )|lo < 1 also satisfies each of the specified design requirements. 
The scaling of the integral errors was chosen to be small (1 x 107°) in order to limit 
the conservatism of the 7H. constraint. Adjusting these values principally influences 
the time constant of the washouts. 

Figure 5.7 depicts the optimization history for this problem. 
The top graph depicts the progress of the controller margin with each iteration. The 
second graph shows the progress of the total cost with each iteration The lower graph 
depicts the progress of the plant parameters. Three optimization runs are shown, 
initialized at values of Go = [10, 10)’,[0.12, 50]7, and {1, 20]?. The plots were 
slufted horizontally so as to terminate at lke same iteration count. 

This example has a number of interesting features. First of all, 
note that the final output value was independent of the initialization conditions. 
While this by no means proves the existence of a unique minima in the feasible set, 
it is an encouraging result. Secondly, unlike the single variable problem, which was 
known to be quasi-convex, the controller margin does not decrease monotonically with 
each iteration. Finally, during the progress of the optimization, the stab control power 
actually falls below its convergence value. What is significant, however, is that the 
total cost continues to decrease monotonically as the stab control power overshoots its 
optimal value and then corrects. About a dozen permutations of this problem were run 
with various weighting vectors and differing performance specifications. The following 
identically significant behaviors were observed: 1) the output values were always 
independent of the initialization vector ¢9; and 2) the total cost always decreased 


monotonically. 
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Figure 5.7: Optimization History for Longitudinal F-14 Problem with Mul- 
tiple Initial Conditions (Example Five) 

Another issue of significant importance is actuator activity. It 
might be expected that the optimization routines minimized control power at the 
expense of unacceptable increases in actuator activity. This turned out not to be the 
case, since actuator deflection was constrained as a part of #7, problem formulation. 
Figure 5.8 shows the broken-loop control responses for the stab and DLC actuators. 
With cross-over frequencies in the range of one to three rad/s, the actuator demands 
for this problem are about one order of magnitude less than modern flight control 


actuator capacity. 
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Figure 5.8: Broken-Loop Control Response for Longitudinal F-14 Problem 
(Example Five) 


(2) A Lyapunov Approach 
The second approach using the closed-loop formulation was to 
consider the closed-loop transfer function from the command reference signal to each 
control as an output, and explicitly limit the steady state value. Let A; be the 


row of the state-feedback gain matrix corresponding to the control input u;, and let 


i ee The closed-loop transfer function from w to wu; is: 
T.,.w(s) = Kj (sl —~(A+ Bok))” B,. (5.46) 
Enforcing 
Tu,w(0) < 
yields: 


Nee K,(A + Bok)" B, > 0. (5.47) 


Note that since 7, is scalar, this is equivalent with the expression: 
det (ni + Ai(A + Boh')"'B,) > 0. (5.48) 
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Recall Schur’s determinantal formula [Ref. 41], that given: AJ = | : . | and 
detii?) = 0: 


det(M) = det(*) det (J — HFG). (5.49) 


Consequently, 


det 


—(A ale , | det (7m + K,(A + Bl’)! By) det (—(A + Bal’) 


Bh; 
="aet (= + Boh) - an.) det (1;). 
UE 
Equation 5.48 is consequently equivalent with: 
det(7; ) : Bh; 
———_———_—- det | —(A + B2lv ) — —— UE a 
Ue Saya ( (A+ Boy) , )> (je) 


Note that det(n;) > 0. Furthermore, assume (A + Bz) is stable, which implies that 


det (—(A + B2h)) > 0. The constraint can now be expressed as: 





Bh, 
det (=(4 + Bh) - ts a: (oot) 
UR 


Note that (A + Boh + fake | stable is a sufficient (but not necessary) condition for 
satisfaction of this scalar inequality. If we again use the controller parameterization 
I = WY7!, this can be expressed by Lyapunov’s equation as the LMI: 


BWi+ WIBT 


AY +YA'+B.W+Wi BI + 
UF 


(5.52) 


An example problem using this formulation were not completed, however, the codes 
supporting this approach are included in Appendix D. 
b. Dynamic Maneuverability Requirements: Open-Loop For- 
mulation 
In this section we propose a methodology for inclusion of open-loop 


tnaneuverability constraints in a strictly open-loop formulation. As discussed earlier, 
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such constraints may include maximum pitch rate, roll rate or yaw rate requirement 
with all the control surfaces set at their maximum deflections. It turns out that these 
constraints can be derived using the open loop linear plant matrices such as Agero 
and Boero introduced in the previous section. 

Assume that the scalar output z =r is also represented by one of the 
states of the system, x;. With all other states zero, the maximum steady state value 


of x, can be expressed by: 
C= Ananda: + Bz, \tmar, (Soon 


where Aj,;) denotes the 2-th diagonal element of A, and B,,., denotes the corre- 
sponding row of B,. Note that Aj;,;) must be negative in order to represent a stable 


equilibrium condition. The open-loop constraint can now be posed as the inequality: 
AN Rc + Bo, tmar olill (5.54) 


This is now affine in our plant matrices, and the plant optimization constraint can 


be posed as the LMI: 
= AVP | ile = Bz, \C)Umas Ue ( 5eaa)) 


Note that the assumption can be relaxed that < be represented by a system state. 
This is because if z = Cr, then a similarity transform S exists which can make z a 


state r, of an equivalent system: 
t= Att Bou: 2= 4). (d.0) 


Furthermore, if A and By are affine in ¢, then A(C) = SA(C)S7! and B2(¢) = SB2(C) 
are affine in ¢. 
Constraint 5.55 can therefore be posed jointly with any of the other 


proposed constraints, and the plant/controller optimization problem solved as before. 
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Because this constraint 1s truly open-loop, and only applies to the plant optimization 
phase of the routine, it can be omitted from the constraints imposed during the 


closed-loop controller optimization as with constraint 5.29. 


Example Sir- Optimization of Multiple Surfaces with Open and Closed-Loop Perfor- 


mance Requirements 


Let’s revisit the F-14 longitudinal example. This time consider the 
additional open-loop maneuverability requirement that adequate control power exist 


to generate at least 0.5 rad/sec of positive pitch rate with the stabilator deflected 20 


degrees from the trimmed value, and the DLC neutral. Consequently, stabmar = aa 
radians and equation 5.55 now becomes: 

_— 20 ; 

= Aaeroys 3) (6 )(0.2rad) = Bacros.s) (aaa =) (et) 


This LMI was included in the plaut optimization phase of the plant / 
controller algorithm. Figure 5.9 depicts the progress of the algorithm. The addition of 
this open-loop maneuverability constraint resulted in an increase in the required size 
of the stabilator from 0.12 to 0.34 of its normalized value. The DLC size predictably 
remained the same as in Example Six. The results shown in Figure 5.9 indicate that 
the closed-loop H performance constraint was responsible for sizing the DLC, while 
the open-loop maneuverability constraint was responsible for appropriately sizing the 
stabilators. The abrupt change in the controller margin is for the identical reason as 


that explained in Example Four. 


Solid: Hinf + Open-loop Spec 





Controller Margin 


0 10 20 30 40 50 60 
Iterations 





rr 
‘@) 
O 
c 
& 
oO 
0 10 20 30 40 50 60 
Iterations 
10’ 


Stabilator 
oO 





0 10 20 30 40 50 60 
Iterations 


Figure 5.9: Optimization History for F-14 Problem with Open-Loop Con- 
straint (Example Six) 


Example Seven-— Optimization of Multiple Surfaces with Open and Closed-Loop Per- 


formance Requirements and Directed Thrust 


The objective of this example is to demonstrate that more uncon- 
ventional control effectors can be easily incorporated into the proposed methodology. 
Therefore, in addition to the aerodynamic control surfaces, provision was made in the 
model for the deflection of the engine exhaust to provide additional moment (directed 


thrust). In this simplified model the thrust is set to the trimmed value of 13,118 bf, 
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and ancillary nonlinear effects of thrust vectoring, such as entrainment, are ignored. 
The commanded thrust deflection is set to be equal to the stabilator deflection, with 
similar actuation rates, such that O¢nrus: = Ostas- Consequently, the controls problem 
remains a two-input problem. 

We first discuss incorporation of the directed thrust into the synthesis 


model. Define the following parameters: 


To := trimmed thrust value (lbf) 
1. := engine lever arm (ft) 
© i= thrust deflection angle (rad), relative to body axis 


0 
0.. ‘= nominal installed thrust deflection angle (rad). 


| 


Using above notation and the notation of the previous section, the nonlinear directed 


thrust contribution to the state derivatives can be expressed as: 


U ~ cos(0,) 

Gy = ——, sin(0,) ue 
Q pe PU EIND 2s) 
O thrust 0 


Linearizing equation 5.58 about a nominal flight condition results in the following 


expression: 
ul —+ sin(0.,) 
ay ——, cos(@,, ) 
cca fy mV A J. —0.,). 5.59 
j O —TN Gos.) ( a) (5 9) ) 
0 
thrust 


Incorporating directed thrust in the aircraft dynamics results in the new expression 


for Boero defined in equation 5.40: 


miss = lope te io prenn & Ar Bigeres G2 





—-Tosin(9,.) 0 0 0 
—-!.T) cos(6 0 (' b6 | 0 
= mV 0 Cos( co} = L stab 
F —7-Tol. cos(@,, ) 0 si tn —l stab 0 1 s 
0 0) 0 0 


Hang 


0 Cipppe | C Bare 
aa Oe b 0 C 
- 0 Omer Cane 
0 O 


(5.60) 


Note, whereas Baero, had previously been zero, it has now includes the directed thrust 
contribution. 
The open-loop maneuverability specification given by equation 5.57 


retains the same form. When expanded, this inequality is now: 


1.19 cos(O., ) 


(0. — 0.) > 0. arene 
Lyy 


= Aaeroys,3) (4 )Qmaz me ee ope Galas = 


The expectation was that significantly less stabilator control power would be required 
due to the ability of the directed thrust to aon large moments. 

As can be seen from Figure 5.10, the methodology determined that 
essentially no stabilator control power was required in order to meet the specifications, 
and a controller was found which satisfied the requirements using directed thrust and 
DLC alone. Note that the availability of the directed thrust did not decrease the 
amount of DLC control power necessary to meet the requirements. This was to be 
expected since the influences of these two control inputs on the plant dynamics are 
nearly orthogonal. 

This example demonstrated that that diverse control inputs, such 
as directed thrust can be handled by the methodology we’ve proposed. However, 
additional constraints will have to be imposed to guarantee a satisfactory solution for 
flight conditions where thrust setting 1s not constant, such as terminal area flight. 

In this section we have shown that the proposed methodology can 
easily accomodate various static and dynamic maneuverability requirements. In par- 


ticular, it was demonstrated that these requirements can be formulated as LMI’s and 


120 


— 





Controller Margin 
=A —s 
Oo 2 -@ 








0 20 40 60 80 100 120 140 
Iterations 
D 
ro) 
O 
iz 
& 
o 
0 20 40 60 80 100 120 140 
Iterations 
5 10 
© 
5 10 
8 
10 
0 20 40 60 80 100 120 140 
Iterations 





0 20 40 60 80 100 120 140 
Iterations 


Figure 5.10: Optimization History for F-14 Problem with Directed Thrust 


(Example Seven) 


included in the plant/controller optimization algorithm together with the closed-loop 


performance and stability constraints. 


F. ACCOMODATING MODEL UNCERTAINTY 


of the linear plant. 


The hazards associated with under-designing the control power are extreme, 


and yet the answers determined by the methods above presume perfect knowledge 


that provision was made in the design process to ensure that inaccuracies in the 


eal 


As a consequence, sound engineering practice would demand 


linear synthesis model would not be responsible for the gross under-design of the 
control surfaces. If one’s confidence in tle aerodynamic derivatives was within ten 
percent, then the temptation might be to simply pad the tail size by ten percent. This 
methodology would fail to recognize that it is the dynamics of the whole vehicle which 
are uncertain, and might result in sub-optimal allocation of the control power to cope 
with the other uncertainties in the knowledge of the plant. Because of the small gain 
theorem (Theorem 3.7), the #H., methodology of section C was easily extensible 
to the problem of providing robust control, and optimization of the vehicle control 
power which would guarantee both robust stability and fulfillment of the performance 
objectives. 

This proves to be an interesting problem, because the formulation of the syn- 
thesis model for plant optimization with a welt stability constraint is significantly 
different from the #(,. constraint posed above. Consider again the uncertainty model 
for longitudinal aircraft dynamics presented in Chapter IV, in which parametric un- 
certainty was modeled by uncertainties on the total lift, drag and moment gener- 
ated by purely aerodynamic forces. Figure 4.1 depicted the inputs and outputs of 
the uncertainty block. Consider the linearization of that nonlinear plant, replac- 
ing Foray alld Fayn With A,g) GllG@mad, yen) Ulm @ jemmlad eee represent that the 
aerodynamic influences such that A,.,. introduced in equation 5.39 has been decom- 
posed into its aerodynamic, gravity and dynamic coupling contributions, such that 
Agee = Agra Ade 

The uncertainty inputs and outputs to the linear system can then be represented 
as depicted in Figure 5.11. The system depicted by Figure 5.11 can be posed in a 


state-space representation: 


G — ! ie = (Acero(C) a By(C) hv )zx =F Rupws 
A ozs = (Asero(C) + Bo(C)K)z 





Figure 5.11: Linearized Uncertainty Model 


By the Small Gain Theorem, the closed-loop system will be stable for all {A : [Al]. < I}, 


if and only if ||T2,0|lo. < 1. This constraint can be expressed by the LMI: 


Ane acyl ar Y Agero(C)'+ 1 Pa , B rvs 
e > A aero ) B W 
Br(C)W + W'BA(C) + Res Riy J orelQY FRAT | og, 
(Aaero(C)Y + B2o(C)W) —/ 


PO cm ee. 


The problem is different from those encountered previously in that this single matrix 
inequality is affine in both the controller parameters (W(€),¥(€)) and the plant 
parameters ¢. This LMI can consequently be used for both phases of the optimization 
procedure. 

Time precluded the completion of a design example using this formulation, 


though the scripts which support this problem are included in Appendix D. 


G. GENERAL COMMENTS 

This section presents several diverse comments on the methodology presented 
above. 

1. Interpreting the Results 

What does the output of this methodology mean? Two mathematical issues 

are significant. First of all, though each of the two phases of the method are affine 
problems, and despite considerable effort, we have been unable to mathematically 
establish that the feasible set for the joint controller/ plant optimization problem is 
convex. Consequently, absent a proof of convexity of the feasible set, the existence 
of lower cost solutions can not be discounted. Secondly, a feasible solution to the 
appropriate LMI is both necessary and sufficient for the existence of a state-feedback 
controller satisfying either the 7, etree or the pole placement specification. 
When more than one 7H. constraint is jointly imposed, or the H. constraint 
is imposed jointly with another constraint, such as pole placement, then a feasible 
solution to the joint LMI is clearly a sufficient condition for a feasible controller. 
It is no longer, however, a necessary condition [Ref. 25]. Again, absent a proof of 
necessity, controllers might exist which would permit further reduction of J. The 
output J = c’ Co is consequently an upper-bound to the optimum value of J. 


2. The Example Problems 


It is important to mention that the first several example problems could 
have been solved by easier means. These examples were not intended to suggest 
that our methodology should be used to solve these types of problems, but rather to 
dlernonstrate the methodology on small easily visualized problems. The answers in fact 
confirmed our intuition into these simple problems. The power of the methodology is 


its direct applicability to much more complex problems with multiple variables and 


joint constraints, for which no other direct method exists. 
3. Limitations of the Methodology 
It is 1mportant to identify the limitations of the methodology. The above 
examples demonstrate the viability of the method. and its flexibility to simultaneously 
adjust to diverse specifications. There were however two assumptions which implicitly 


limit its application: 
1. The linear model faithfully represents the dynamic character of the plant 


2. The plant could reasonably be expressed as an affine function of the optimization 


parameters. 


Neither of these assumptions was considered to be significantly limiting. as there are 
a wide range of examples for which they are both reasonable. It is worth noting for 
the reader one example for which an aircraft would not be affinely dependent upon a 
control size. In the case of a closely-coupled canard. the affine assumption would not 
be reasonable. as the size of such a canard can have a dramatic effect on the influence 
coefficients of the surfaces located in its wake. 

Furthermore, there is one other significant explicit limitation— the exis- 
tence of a feasible controller. Several example problems were attempted for which no 
feasible controller could be found. This was most common when multiple joint spec- 
ifications were imposed. The methodology cannot guarantee a prior: the existence 
of a controller in the presence of conflicting. or mutually incompatible, performance 
criteria. 

4. Other Applications 

The focus of both the discussion and the examples has been the optimiza- 

tion of control power, i.e. those items whose principal influence manifests itself in 


the B matrix of the state-space representation. Furthermore, the examples have each 
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suggested that the size of surfaces might be the principal figure of interest. The ap- 
plication of the methodology is not, however, restricted to those features of a vehicle 
which represent control power. Any feature whose contribution to the dynamic system 
can be posed in an affine manner can be included in the vector of plant parameters, 
and consequently be reflected in the cost function. Strakes and fixed fins would be 
examples of features which might only have a contribution in the A matrix, but are 
likewise perfectly suited to the application of this method. Occasionally, destabilizing 
features such as blisters, antennas or external stores must be appended to a vehicle. 
The methodology can then be applied to find the marimum acceptable size of the 
feature by including the negative contribution of the feature in A(¢), and finding the 
minimum negative value of the sizing parameter. Finally, recall that in the example 
problems that the tail volume was defined sis the normalized product of the surface 
area and its distance from the cg. The influence of a feature is consequently also affine 
in its position as well as its size, and so the methodology might instead be applied 
to optimizing position rather than size for some applications. The method presented 
in this chapter is consequently broadly applicable to a wide variety of problems not 


demonstrated here. 


H. FUTURE DIRECTIONS 
The following subjects present the foundations for future work. 
1. Convexity Issues 
Though the value of the above methodology does not. hinge on the problem 
being proven to be convex, convexity remains an interesting subject. This is partic- 
ularly true if the method is to be expanded to other applications. One particularly 
interesting direction to be pursued is the method's close resemblance to D-K itera- 


tion {Ref. 34]. D-K iteration is a method by which robust controllers are designed 
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by iteratively designing a controller and then performing a similarity transform on 
selected inputs and outputs to scale for robustness. ‘Though the method has been 
recognized and used for some time by the controls community , special cases of the 
problem were just recently proven to be convex [Ref. 42, 43]. The similarity of these 
two problems tenders some hope that the problem we've posed may yet prove to be 
convex. 

In the event that general convexity can not be demonstrated, perhaps the 
mathematical nature of the problem can further be refined to enhance our understand- 
ing of the result. Can a lower bound be computed? Is the result a local or global 
minimum? Are there other special conditions for which convexity of the problem can 
be assured or imposed? For example, if one could determine the smallest convex set 
which contained the feasible set, then a lower bound could be found by minimizing 
the cost function over that convex set. A lower bound close to the upper-bound found 
through our iterative methodology would be of tremendous practical value. These are 
subjects which each warrant further investigation. 

2. Other Convex Performance Constraints 

A second limitation to the above approach was its restriction to those con- 
vex constraints for which an LM] formulation exists. A number traditional perfor- 
mance metrics are convex problems for which an LMI formnlation does not presently 
exist [Ref. 13], including overshoot, rise-time, settling time, and response bandwidth. 
The above methodology can and should be expanded to include these types of per- 


formance specifications. 


I. CONCLUSIONS 


While establishing the minimum control power requirements for a aircraft has 


always been a concern, it 1s now a core design constraint with the advent of aircraft 


Ie 


whose open-loop dynamics may be unstable. With an unstable platform, the control 
effectors must now not only provide the capacity for adequate maneuverability, but 
also provide stabilization and disturbance rejection. For this type of vehicle, if an 
control actuator encounters a deflection or deflection rate limit in providing maneu- 
verability, it reverts to its natural dynamics in response to any disturbance. Missteps 
in this arena have been well documented. The loss of the prototype Grippen on its 
sixth flight was attributed to saturated control rates in an environment where linear 
aero and flight dynamics prevails [Ref. 44]. To under-design the control power is to 
court disaster. To compensate for the hazards by over designing the control power is 
to forfeit all the benefits offered by reduced static stability (low monetary cost, high 
maneuverability, low drag, low signature, low weight). 

Direct numerical methods have been Wecdad in which performance requirements, 
iicluding actuator rates and deflections, are the inputs to a methodology which then 
can simultaneously determine both the lowest “cost” configuration and its accom- 
panying controller. This chapter demonstrated that many common flying qualities 
specifications can be posed as Linear Matrix Inequalities. These included stabilization 
requirements, disturbance rejection requirements, and static and dynamic maneuver- 
ability requirements. Furthermore, a iterative method of optimizing a plant config- 
uration was demonstrated when the performance constraints can be posed as Linear 
Matrix Inequalities. This work is at a threshold, having demonstrated a viable means 
for solving a significant subset of control power problems, and suggesting an approach 
to pursue the larger set of convex performance constraints, which predominate the 


flying qualities specifications. 


J. RECOMMENDATIONS 


It is recommended that the following steps be taken to further the contribution 


of this work: 


|. Procure commercial interior point codes when they become available. The point 
here is to separate the influence of the numerical methods from the application 
of the engineering formulation. The coding of the interior point algorithm in 
Appendix B restricts the engineering application of the above formulation in two 
ways: (1) it 1s slow due to the choice of MATLAB as the programming language. 
and (2) the code demonstrated some irregularities, such that there were some 
problem geometries for which the path of centers was unstable. Consequently 
some interesting feasible example problems were attempted which the available 


interior point code would not solve. 


2. Extend the general methodology to other performance measures which have 
convex solutions, but which do not currently have LMI formulations. Many 
other relevant convex constraints exist, such as command and controller band- 
widths, which could also be applied if the method were extended to non-LMI 


formulations. 


3. Continue to pursue attempts to either prove convexity or find associated convex 


problems which could be used to determine a lower bound. 


VI. CONCLUSIONS AND 
RECOMMENDATIONS 


This report has treated the subject of the application of H. control design 
and convex optimization to the design of air vehicles and their control systems. Three 


project areas defined the scope of the research effort: 


e An HH, controller design for the F-14 autoland problem, implementing Direct 


Lift as an active control surface. 


e The programming of mixed 7H, / H. design tools, and their application to the 


autoland controller design problem. 


e The formulation of the plant /controller optimization problem in a format where 


an upper-bound can be determined by convex methods. 


ach of these efforts were successfully completed, each with their own sets of conclu- 


SIONS. 


A. H, DESIGN EXAMPLE CONCLUSIONS AND RECOMMENDA- 
TIONS 
The H. output-feedback synthesis methods were used to determine an au- 
toland controller for a carrier-based F-14 aircraft. Significant results of this efforts 


WEE: 


1. A methodology was demonstrated for the formulation of robustness analysis 
models for aeronautical applications. This methodology is appropriate for those 
problems in which the origin of the parameteric data is flight test rather than 


wind tunnels. 
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Ne 


Direct Lift Control was successfully implemented in a MIMO design for the 


autoland problem. 


3. A methodology was demonstrated whereby SISO design specifications were 
translated in scalar weighting functions on the inputs and outputs of the syn- 
thesis model. This included tuning the controller for specified bandwidths of 


the measurement sensors. 
4. A controller was designed which did not cancel the open-loop poles of the plant. 
5. The controller performance was validated by nonlinear simulation. 


This design example extended the methodology of previous work to the full mea- 
surement feedback problem. The methodology is recommended for consideration 
whenever #H,, control design methods are considered for use. Its principal attribute 
is that it represents a methodology by which a controls designer with limited back- 
ground in the theoretical aspects of 7, control can still apply the design tools with 


confidence. 


B. MIXED #2 /H. CONTROL CONCLUSIONS AND RECOMMEN- 
DATIONS 
The mixed H2 / H.. control phase of the research included both the coding of 
the necessary design tools for both the continuous and discrete time problems, as well 
as their application to a design problem similar to the F-14 autoland problem above. 


Siginifcant results included: 


1. Design tools were created which solve the continuous and discrete time mixed 
Hy / H. controller synthesis problems using elliptical convex optimization 


methods. 


Ihe] 


2. The F-14 autoland control problem was used to demonstrate a methodology 
whereby the continuous Hz / H, control design tools could be used in a MIMO 


controller synthesis problem. 


Due to the computational time required to use the mixed tools, 1t 1s recommended that 
they only be applied for design problems in which an #) specification was explicitly 


part of the design requirements. 


C. PLANT/CONTROLLER OPTIMIZATION CONCLUSIONS AND REC- 
OMMENDATIONS 
Chapter V was devoted to outlining and demonstrating a methodology whereby 

the optimization of a vehicle’s physical configuration could be posed for solution by 


the methods of convex analysis. Specifically: 


1. It was demonstrated that many typical flying qualities requirements can be 
jomtly posed as Linear Matrix Inequalities, including: 
e Stabilization requirements, including pole placement, 
e Disturbance Rejection, 
e Static and Dynamic Maneuverability (Open-loop) Requirements. 


2. It was demonstrated that plant dynamics are frequently affinely dependent on 


some physical attributes of the physical configuration, such as surface size. 


3. A methodology was presented for determining an upper-bound to the plant/controller 
optimization problem. The method is appropriate for problems in which the 
design specifications can be posed as Linear Matrix Inequalities and the plant 
dynamics are affinely dependent upon plant parameters. This problem was 


shown to be quasi-convex for the optimization of single plant parameters. It 
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was also shown how the method results in the determination of an upper-bound 


for the cost functions for multiple parameter problems. 


. A methodology was outlined for accommodating modeling uncertainties into 


the plant/controller optimization problem . 


Multiple design examples were presented whereby joint performance require- 
ments were applied to the problem of optimizing aircraft control surface config- 


urations. 


This represents the principal major contribution of this research effort. It 1s recom- 


mended that the following items be pursued in this area: 


ie 


Lo 


Commercial interior point codes should be procured when they become avail- 


able. 


The general methodology should be extended to other performance measures 


which have convex solutions, but which do not currently have LM] formulations. 


The issue of convexity should continue to be explored. including attempts to 


identify bounding convex sets. 
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APPENDIX A:ALGORITHMS FOR THE 
SOLUTION OF THE MIXED #2 / He 
CONTROLLER SYNTHESIS PROBLEMS 


This appendix presents the numerical tools which were coded to solve the mixed 
Hz / H. control synthesis problem. It includes both the mathematical derivations of 
various terms, as well as verbatim listings of the final codes. Since no numerical codes 
were available to solve these problems, a considerable amount of time was devoted 
to the design of the necessary numerical routines. The optimization problems in this 
appendix were all solved by the ellipsoidal method. 

First, section A presents several Pcie but perhaps obscure, relationships 
which were critical to the derivation of analytical expressions for the gradients of 
the various matrix functionals. Next, section B presents the codes associated with 
the continuous time H2 / H, problem. Section C tlen presents tle codes associated 
with the discrete time mixed Hz / H. synthesis problem. Finally, section D presents 


a short discussion of the validation of the codes. 


A. FINDING THE GRADIENTS OF MATRIX FUNCTIONALS 


Both the continuous and discrete Hz / H, state-feedback problems can be 
numerically solved by the straightforward application of the ellipsoidal convex op- 
timization algorithm, described in Chapter II. In both cases, the most challenging 
part was the derivation and coding of analytical expressions for the subgradients 
of non-differentiable functions. The following relationships are instrumental in the 


derivations of the subgradients that follow. 
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1. Derivative of an Eigenvalue of a Symmetric Matrix Functional 
Since most of the constraint functionals (and some objective functionals) 
are of the form Q(x) < 0, it is necessary to be able to determine the gradient of 
$(2) := Amer(Q(z)). From [Ref. 45], given a symmetric matrix functional Q(r) = 
Q(x)? ER"”” operating on xr ER®, and the scalar function ¢(7) := Amar(Q(x)); the 


gradient of (1) is g, such that for each element of g: 


— 9¢(t) og, IQ(2) — . 
UT asles allaal Coreen feo reat |= ts as (A.1) 


where u(x) is the eigenvector associated with the maximum eigenvalue of Q(x), and 
w"(a) 1s its conjugate transpose. 
2. Derivative of a Matrix Inverse 
Matrix inverses occur frequently in various Riccati equations. An expres- 


sion for their derivatives 1s consequently required. From [Ref. 46]: 
dN XN) =d]0=dn Na dX, 


hence, 


Ae ee 


B. CONTINUOUS TIME MIXED #2 / H, CONTROLLER DESIGN 


As discussed in Chapter ITI and [Ref. 11], the continuous mixed out put-feedback 
control problem is based upon a convex expression of the state-feedback problem. It 
can be solved by the solution of the filtering Riccati equation, and the construction 
of an auxiliary plant for which a state-feedback controller is designed. This section 
consequently develops and lists the state-feedback controller design tools which can 
either be used independently or called by the output-feedback synthesis function. The 


measurement-feedback controller synthesis tools then follow. 
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1. Numerical Solution of the Continuous Time State-Feedback Prob- 
lem 
The generalized mixed continuous 12 / 7H. state-feedback problem is 
posed above in Theorem 3.4 as: 


Minimize: 
fi M(W,Y)) 2= fi ((CoY + Doo )¥~"(Co¥ + DoW)? }, (A.2) 


Subject to: Y > 0, and Rh(W.Y) < 0, 


where 


R(W,Y):= AY + YA" + BW + WW! BS 4+ By, BP + (CY + DieW)(C\Y + DoW), 

CASS) 
and f; 1s the trace, fz is the maximum eigenvalue, or fs is the maximum diagonal 
element. The #H, constraint is assumed to be 7 < 1, and w and z are assumed to 
have been scaled in order that the constraint || 7.,. |lo< 1 is feasible. The codes 
which follow also required that w and z have been appropriately scaled. 

For the state-feedback problem, the controller is a constant gain matrix /y 
which has been parameterized as K = WY7!. Since Y = Y7 € R"*” is symmetric, 
the problem ts a search over the vector space R*, where s = UE +nq. For simplicity 
and reduced computational expense, Y and W were chosen to be affine functions of z: 
Y= _, rid;, and W = 577_, 7;W;. The easiest possible mapping from z — (W,Y) 
was to assign each z; to a single location (or pair of locations in the case of the off- 
diagonal elements of Y). The basis matrices ¥Y; and W; therefore orthonormal with 
a single unit one (or pair of ones). For 7 = 1 to n, Y; had a single unit value in the 
corresponding diagonal position, and W; = 0. For 1 =n +41 to we each Y; had a 


pair of symmetrical ones placed by counting down each sub-diagonal, from the first 


. I 
sub-diagonal out to the corners. For 7 = one to mth) + nq , each W; was all zero 
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with the exception of a single one, counting down the columns from left to right. For 


this range Y; = 0. This structure is significant in that when Y; and W; show up in the 


gradient expressions, the multiplication was not required, but the appropriate row(s) 


or column(s) simply selected out. 


An ellipsoidal algorithm was coded in MATLAB following the method of 


Chapter II and using the following structure: 


=] 


. Determine if the 7. problem is feasible. and determine a particular feasible 


controller Ap. This was done by solving the HH. synthesis equation using the 


Riccati solvers in the y-tools toolbox [Ref. 24]. 


Determine an initial feasible solution }, aud WW, = A,¥, from a solution to the 


H.. analysis equation (3.2). 


ip 


Initialize the search at r = [0,...,0]°, with a very large ellipsoid about vr. 


From x, determine )’ and IV as perturbations of the particular solution (1W,, ¥;). 


Evaluate the constraint @)(2) = Ajay(—-¥) < 0. If @:(r) > 0, then use the 
eigenvector associated with the maximuin eigenvalue to calculate the subgradi- 


ent: g, = 22). Update the ellipsoid and xr and return to step 4. 
7 Or P | 


a 


Evaluate the constraint $2(0) = Amaz(R(W,Y)) < 0. If do(r) > 0, then use the 


eigenvector associated with the maximum eigenvalue to calculate the subgradi- 


elit > = aoa . Update the ellipsoid and x and return to step 4. 


. With both constraint functionals satisfied, evaluate the objective function y)(a) = 


f(M(W,Y)) and its subgradient: g3 = ot) Update the ellipsoid, x, and the 


upper and lower bounds on the estimate of the optimum cost. 


Return to step 4 unless the termination criteria is satisfied. 
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9. Calculate the (sub)optimal controller 4 = WY7!. 
10. eat. 


Two significant computational issues were involved in actually coding the 
above routine: 1) how to test for positive definiteness; and 2) how to calculate the 
maximum eigenvalue and its corresponding eigenvector (both for the subgradients 
and the fo generalized cost). The first was important because both of the above 
constraint functions required a true/false assessment of the negative definiteness of 
—Y and R. Two methods were considered: Cholesky factorization, and the compu- 
tation of the maximum eigenvalue. If a Cholesky factorization of Y or —R could be 
computed, then that expression was positive definite, and the procedure could move 
on to the next step. If the factorization failed, then the maximum eigenvalue and 
its corresponding eigenvector would have to be calculated for the subgradient calcu- 
lation. The advantage of a Cholesky test, is that it is a very efficient calculation, 
which, if successful, would avoid the comparatively expensive eigen-problem for that 
step. As for the determination of the maximum eigenvalue, two choices were appar- 
ent. Clearly one choice would be to invoke MATLAB’s eig function and solve the 
whole eigen-problem. The second choice would be to use inverse iteration to isolate 
just the maximum eigenvalue and it’s vector. The eig function was chosen because 
the MATLAB implementation is native to the MATLAB core program, and takes 
advantage of symmetry for problems such as this. It was consequently faster to do 
the entire eigen-problem by eig than run a line-compiled subroutine, though the later 
required fewer flops. Similar results were encountered in choosing a method for the 
definiteness test. Though a version of h2infsyn successfully ran using a Cholesky 
test, it was no faster than the eigen test because of eig’s implementation directly in 


MATLAB. Furthermore, the Cholesky dependent variant was not as reliable when 
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large problems were run. Consequently, the reader will note that eig was chosen in 
resolving both issues. These choices should be reevaluated in the event that these 
codes are translated into either FORTRAN or °C. 

The gradient expressions are derived below for the each of the z = 1 to n 


elements: 


_ OO;(z) 
Gigs = aa 

oy 

Oz; 


= ee al 








= —tUwu Uu 


= —tr(Yj;uu"). (A.4) 


, Z Oo2(z) 
G2, al Or, 
ORW.Y) 
—_—________—* } 
Oz; 
O 
= wo {AY +YAT + BW + WBS + BBP + 


Ox; 


(ChY + DiW)(CiY + DirW')" } Ms 





= tt 


= w {A+ VAT + Bl, + VT BY + 
(Ci¥ + DieW (CY + Dial)? + (CLY + Do W)C + Day)" } u 
= tr({A¥i+ YA? + BW, + W BY + 
(Cra sar BPA V (Gr ee Drea ademas Geatae ame hea tay Gee ame Dy,W;)"} wu") 
=e tr ({(Ciy Den Bre aie Grae uu" A} ny + 
2tr({(CiY + DiaW’)uu" D2 + uu" By} W,). (A.5) 
The arrangement of these expressions is not unique, but has been chosen 


deliberately to place the basis matrices W’, and Y; on the outside of the argument of 


the trace. The nature of the basis matrices IW, and Y; being all zero except a single one 


a) 


or pair of one’s, meant that neither the evaluation of the trace nor the multiplication 
by W, or Y, was required, but simply the selection of a single appropriate element out 
of the central expression. 

In the case of the objective function, the gradient will first be derived for 


ff. (max eigenvalue). 


OW(z) — Ofa(M(WLY)) — OAmar( MW. Y)) 


Je Ox; Ox; ~ Oa; 
_.OM(W,Y) 
= 1 Se - U 
Or; 
Pe O 7—] bg r\T 
= u's— {(CoY + DaW)¥~'(Co¥ + Dorit’)? bu 
Oz; 


= ué{(Co¥i + DoaWi)V¥—'(Co¥ + DoW)? 
+(CoY + DoxW)¥ (Co, + DoW)? 
—(CoY + DoaW)¥ "YY" CoY + Doal)? +} w 
= tr{(¥(CoY + DoW)? utuCo + Cluu(CoY + DaW)Y~") ¥;} 
—tr{¥~"(Co¥ + DoW )Tu"u(Co¥ + DaW)Y"¥,} 
ttr {¥7'(Co¥ + DoW)" u"uDooW, + WI Dou"u(CoY + DW)Y7'}. 


(A.6) 


The gradients of f,(A7(W.Y)) and f3(A7(W,Y)) are then minor modifica- 
tions [Ref. 29]. For f,, replace u*u with the identity matrix 7. For f3, replace u with 
the elemental vector e; = [0,...,0.1,0,...,0]7, where the unit digit corresponds with 
the position of the maximum diagonal element. 

2. Continuous Time H, / H,. State-Feedback Synthesis Codes 

This section lists the continuous mixed Hz / H~ state-feedback controller 
design codes. The function h2infsyn 1s the principal script. The function 
h2infformc is an administrative script that maps a into W and Y. Finally, the func- 


tions subgradic, subgrad2c, and costgradic calculate the subgradient vectors for 
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the two constraint functionals and the cost function. The coding of the subgradieuts 
was validated by comparison with gradient vectors which were determined by brute 
force perturbation methods (i.e. g; = Aes te) wilene.e =" (Oi ee Os al) cies Ole): 


h2infsyn 


function ([K,Kp,X,E,count,Psi1,Psi2,outcome,time]=... 
h2infsyn(f,p,Dim,Sf,mitr,exit,Xi,Ei,counti,Psi1li,Psi2i) 


% function (K,Kp,X,E,count,Psi1,Psi2,outcome,time]=... 
y. Neintsyn(f,p,Dim,St ,mitr,exit,X%1,E1,counti,Psiii,Psi2i) 


4 Finds state-feedback gains for (sub)optimal mixed h2/hinf control. 

% Solves for appropriate fi gains with which to build output feedback 

4 controller if input p is auxiliary plant. 

4% Method of evaluating generalized mixed h2/hinf cost function can be selected: 
% f=1(trace), 2(max eigenvalue), or 3(max diag element) 

% System matrix '’p’ must be a packed mu-tools system matrix: 


Vf Dim(1) Dim(3) Dim(2) 

A p = | AA | B1 B2 | 

i, | co | DO1 Do2 | 

ip [<1 | Dil Di2- {| Dim(4) 


7, the columns and rows associated with the input w and the output zl 

1 must have been scaled for gamma=1 

% mitr- max number of iterations 

4% exit- termination threshold for mixed cost, expressed as a percentage 
% the other inputs are for restart and the code should be consulted 


% Outputs: 

% K- dynamic output feedback controller in packed mu-tools format 
% Kp- central controller from Riccati methods 

% count- Returns number of iterations for each path 


% Psii- Upper bound on mixed cost 
% Psi2- Lower bound on mixed cost 
% outcome- textual result 

% time- elapsed CPU time 


time=cputime; 
outcome=’max iterat’; 


% unpack system matrices 
(AA,B,C,DJ=unpck(p) ; 


nstates=Dim(1) ; pdist=Dim(3) ; routput=Dim(4) ; sdof=Dim(5); 
tt=row(C); pq=Dim(2)+pdist; 

Beeb (:,1:pdist); B2=B(: ,pdistt+1:pq); 
Ge=G(1:(tt-routput),:); Ci=C((tt-routput+1):te, :); 


DO1=D(1:(tt-routput) ,1:pdist) ; 


14] 


Di1=D( (tt-routputtl) tt.) pdace). 
DO2=D(1:(tt-routput ) ,pdist+1: pq); 
D12=D((tt-routput+1) :tt, pdistt+1:pq) ; 
BiB1=B1*B1’; % precompute to save flops 


4, Determine feasibility/central controller 


ham=[(AA, ((B1*B1’/0.998)-B2*((D12’*D12)\B2’)); -C1’*C1i, -AA’]); 


(xd .x2> fai1) =ricesehr (ham): aint =% 27 x15 
if (fail>0) 
disp(’Statefeedback Hinf problem infeasible’), 
outcome=’ INFEASIBLE?’ ; 
return 
elseif min(eig(Xinf))<=0, 
disp(’Hinf problem infeasible’), 
outcome=’ INFEASIBLE’ ; 
return 
end 
Kp=-(D12’*D12)\B2’*Xinf; % central controller 


4, Determine specific soln from central controller 


al=AA+B2*Kp; bi=(B1,10000*sqrt (eps) *eye(nstates)]; 


[x1,x2,fail] =ric_schr([al’ ,cl’*cl;-bi*b1" ,-al)); 
if (fail>0)e 

outcome=’INDEFINITE’ ; return 
elseif (min(eig(Yp))<=0), 

outcome=’ INDEFINITE? ; return 
else, 

disp(’State feedback hinf problem feasible’), 
end 
Wp=Kp*Yp; 


4 Initialize problem or use last value? 
count=[0 0 0]; Psil=inf; Psi2=0; 
X=zeros(sdof,1); E=1000*eye(sdof) ; 
if nargin>s, 
count=counti; Psii=Psili; Psi2=Psi2i; 
X=X1; E=E1; 
end 


74 begin ellipsoidal search routine 
for k=1:mitr, 


(W,YJ=h2infformc(X,Wp,Yp,Dim); % maps X to (W,Y) 


[Vy ,Ey]=eig(-Y); 
([Phii, index1]=max(diag(Ey) ); 


% Enforce Y>0 
if Phii>=0, 
g=subgradic(Vy(:,index1) ,nstates,sdof); 


Eg=E*g; gAg=sqrt (g’*Eg) ; Eg=Eg/gag; 


c1=C1+D1i2¥*Kp; 
Yp=x2/x1; 


if Phi1>gag, 


outcome=’indefinite’ ; return 


end 
alpha=Phil/gaig; count=count+[1 0 0]; 


% Enforce hinf constraint 


else, 


L1=C1i*Y+D12*W; 

a=AA*Y+B2*W; 

(Vinf ,EinfJ=eig(ata’+B1B1i+(L1’*L1)); 
([Phi2, index] =max(diag(Einf)) ; 


if Phi2>=0, 
g=subgrad2c(W,Y,Vinf(: , index) ,Dim,AA,B2,C1,D12,L1); 
Eg=E*g; gag=sqrt (g’*Eg) ; Eg=Eg/gag; 
if Phi2>gaAg, 
outcome=’infeasible’; return 
end 
alpha=Phi2/gAg; count=count+[0O 1 0]; 


1 


Given the above constraints satisfied, follow cost gradient 


else, 


end 


end 


(Psi, gJ=costgradc(f,W,Y,C0,D02,Sf,Dim) ; 
Eg=E*g; gAg=sqrt(g’*Eg); Eg=Eg/gag; 
Psi2=max([(Psi-gAg) ;Psi2]); 
PP PSi<Psil . 
Psil=Psi; alpha=0; 
else, 
alpha=(Psi-Psil)/gag; 
end 
count=count+([0 0 1]; 


fo EXit criteria 

if gAg<exit*Psil, 
disp(’Program converged to solution’ ) 
outcome=’converged!’; 
break, 

end 


X=X-Eg*((1+sdof*alpha)/(sdof+1)); 
E=E-2*Eg*(Eg’*((1+sdof*alpha)/(sdof+1)/(1+alpha))); 
E=E*((1-alpha*2)*sdof*2/(sdof*2-1)); 

E=(E+E’)/2; 


time=cputime-time; 
if outcome==’converged!’, 
K=W/Y; 


% Following are called non-organic functions: 
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% function (W,Y,K2]=h2infformc(X,Wp,Yp, Dim) 

% function gli=subgradic(vi,nstates,sdof ) 

”% function g2=subgrad2c(W,Y,v2,Dim,AA,B2,C1,D12) 
% function (Psi,gJ=costgradc(f,W,Y,CO,D02,Sf,Dim) 
% function out=pck(a,b,c,d) from mu-tools 

% function (a,b,c,d)=unpck(p) from mu-tools 


% end h2infsyn 


\{verbatim} 
\nm 


\nid \underlinef{h2infformc} 


\ft 
\begin{verbatim} 
function [W,Y]=h2infformc(X,Wp, Yp, Dim) 


4 reformats the space X in Rs to the two matrices 
4% X is assumed to be comprised of the diagonal rows of Y, starting with the 
7% main diagonal, followed by W in column order 


nstates=Dim(1); qcontrol=Dim(2) ; pdist=Dim(3); sdof=Dim(5); 
j=nstates; 
Y=Yptdiag(X(i:nstates)) ; 
for k=i:nstates-1l, 
1=nstates-k; 
Y=Y¥+diag(X(}+1:9 42), Kk) diag 71-342) kk 
jajti; 
end 


W=Wpt+reshape(X(j+1:j+nstates*qcontrol) ,qcontrol,nstates) ; 


% end h2infformc 


subgradlc 
function gi=subgradic(v,nstates,sdof ) 
% calculates subgradient for first constraint function Y>0 


gi=zeros(sdof,1); 
k=1; 


for i=1:nstates 4% counts out diag rows 
for j=i:nstates+1-1 % counts down diag rows 
if i==1, 
gi(k)=-v(j) *v(j); 
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else, 
gi(k)=-24*v(j)*v(jt+i-1); 
end 
k=k+1; 
end 
end 


% end subgradic 


subgrad2c 
function g2=subgrad2c(W,Y,v2,Dim,AA,B2,C1,D12,L1); 


4% Uses analytical expression for subgradient 
% See page 16 of journal 
nstates=Dim(1); qcontrol=Dim(2); sdof=Dim(5); 


a=v2*(v2’*(AA+L1’*C1)); 
Sy=ata’; 
Sw=((B2’+D12’*L1)*v2)*v2’; 


Kai, 
g2=zeros(sdof,1); 


for i=i:nstates 4% counts out diag rows 
for j=i:nstatest+1-i 7% counts down diag rows 
if 1==1, 
g2(k)=Sy(j,j); 
else, 
g2(k)=Sy(j,j+i-1)+Sy(j+i-1,j); 
end 
k=k+1; 
end 
end 


g2(k: (k+qcontrol*nstates-1))=2*reshape(Sw,qcontrol*nstates,1); 


7%, end subgrad2c 


costgradc 
function (Psi,g3]=costgradc(f,W,Y,CO,D02,Sf,Dim) 


4% computes the cost function/gradient for the mixed H2/Hinf continuous time 
% input argument f selects which of the 3 generalized costs is to be 

% implemented: 

A 1= trace 

yf 2= max eigenvalue 
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yi 3= max diagonal entry 
nstates=Dim(1); qcontrol=Dim(2) ; sdof=Dim(5); 


LO=CO*Y+D02*W ; 
M=LO*(Y\LO’)+S¢ ; 


1f f==1, 
Psi=trace(M); 
b=L0/Y; 
RY=CO’*b+b’? *CO-b’ *b; 
RW=2*D02’*CO; 
else, 
if f==2, 
(V3 ,E3]=eig(M); 
(Psi, index]=max(diag(E3) ); 
v=V3(: , index); 
elseif f==3, 
E3=diag(M) ; 
(Psi, index] =max(E3) ; 
v=zeros(length(E3),1); v(index)=1; 
end 
a=CO’*y; 
b=(v’*L0)/Y; 
RY=a*bt+b’? *a’-b’*b; 
RW=2*(DO2’*v) *b; 


end 
k=1; g3=zeros(sdof,1); 
for i=1:nstates % counts out diag rows 
for j=l:nstatesti-1i % counts down diag rows 
if i==1, 
g3(k)=RY(j,j); 
else, 
g3(k)=2*RY(j,jti-1); 
end 
k=k+1; 
end 
end 


g3(k: (k+qcontrol*nstates-1))=reshape(RW, qcontrol*nstates, 1); 


% end costgradc 
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3. Continuous Mixed #2, / H,. Output-feedback Synthesis Codes 


This section lists the design code for the continuous time mixed Hy / H. 


output-feedback controller synthesis problem. The development follows exactly the 


formulae of [Ref. 11] in constructing a auxiliary plant, solving the HH, filtering 


equation by Riccati methods. This auxiliary plant is then fed to the state-feedback 


controller synthesis code above (h2infsyn). 


h2infopfb 


function (K,Psii,count,outcome,time]=h2infopfb(f,p,Dim,mitr, exit) 


function [K,Psil,count,outcome,time]=h2infopfb(f,p,Dim,mitr,exit) 

Finds output feedback controller for (sub)optimal mixed h2/hinf control. 
Method of evaluating generalized mixed h2/hinf cost function can be selected: 
f=1(trace), 2(max eigenvalue), or 3(max diag element) 


System matrix ’p’ must be a packed mu-tools system matrix: 


Dim(1) Dim(3) Dim(2) 


p = | AA | Bi B2>| 
i360” ~— INE DOA DO2 | 
(r2Ga bee Bl D12 | Dim(4) 
be2 \Wep2Zt D221); DamC5) 


mitr- max number of iterations 
exit- termination threshold for mixed cost, expressed as a percentage 


Outputs: 

K- dynamic output feedback controller in packed mu-tools format 
Psil- Upper bound on mixed cost 

count- Returns number of iterations for each path 

outcome- textual result 

time- elapsed CPU time 


formulae are from Rotea and Khargonekar, CDC Proceedings 12/91 


% unpack system matrices 
(AA,B,C,DJ=unpck(p) ; 


nstates=Dim(1); qcontrol=Dim(2) ; pdist=Dim(3); 
routput=Dim(4) ; moutput=Dim(5) ; 
noutO=row(C)-routput-moutput ; pq=Dim(2)+pdist; 
tt=row(D)-moutput; 

Bi=B(?: ,1:pdist); B2=B(: ,pdist+1:pq); 


S0=6(1:nout0,:); C1=C((noutO+1) :noutO+routput,:); 
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C2=C((noutOtroutput+1):row(C),:); 
DO1=D(1i:nout0O,1:pdist); 
D1i1=D((tt-routput+1):tt,1:pdist); 
D21=D((nout0O+routputt+1):row(C) ,1:pdist) ; 
DO2=D(1:(tt-routput) ,pdist+1:pq); 
D12=D((tt-routput+1) :tt, pdistt1:pq); 

D22=D( (noutO+routput+1) :row(C) ,pdist+1: pq); 


pnom=pck(AA,B,C(noutO+ti:row(C),:),D(noutO0+1:row(C),:)); 


% Designing a pure hinf controller 
disp(’Designing a pure hinf controller to determine feasibility’) 


[Khinf ,g,gfin,Ax,Ay]=hinfsyn(pnom,moutput,qcontrol,0,1,.01); 
if isempty(Khinf), 
disp(’Hinf problem is infeasible’ ) 
return 
elseif gfin<=1, 
disp(’Hinf problem is feasible’ ) 
disp(’Gamma value above is measure of freedom for H2 optimization’ ) 
end 


% Solve the filtering equation 
C2tilde=sqrtm(D21*D21’)\C2; 
ham=[AA’ (C1’*Ci-C2tilde’*C2tilde);-B1*B1’ -AA]J; 
(q1,q2,fail,eig_min]=ric_schr(ham) ; 
if fail>O, 

error(’filtering equation troubles’) 
end 
Q=q2/q1; Q=Q+Q’/2; 
if min(abs(eig(Q)))<-1ie-10, 

error(’Q is not positive definite’) 
end 


% build the auxiliary plant 
AAa=AAt+Q*C1’*C1; 
Bia=Q*C2tilde’; 
B2a=B2+Q*Ci’*D12; 
DO1i=zeros(row(D0O1) ,moutput) ; 
Dii=zeros(routput ,moutput) ; 


paux=pck(AAa, (Bia,B2a] ,[C0;C1iJ , (D01,D02;D11,D12)); 
Sf=CO*Q*CO0’; 
Dima=[Dim(1),col(B2a) ,col(Bia) ,row(D01) ,nstates*(nstatest1)/2+tnstates*col(B2a)]; 


% Design a state-feedback mixed controller for the auxiliary plant 
[Kip,Kp,X,E,count,Psi1,Psi2,outcome,time]= h2infsyn(f,paux,Dima,Sf,mitr, exit) ; 


% Build the dynamic controller 
K=pck((AAa-Bla*C2tilde+B2a*Kip) ,Bla,Kip,zeros(qcontrol,moutput) ); 
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% end h2infopfb 


C. DISCRETE TIME MIXED #2 / H. CONTROLLER SYNTHESIS 
As discussed in Chapter II] and [Ref. 12], the mixed output-feedback control 
problem is based upon a convex expression of the full-information problem. It can 
be solved by the solution of a filtering Riccati equation, and the construction of an 
auxiliary plant for which a full-information controller is designed. This section con- 
sequently develops and lists the state-feedback controller synthesis tools which could 
either be used independently, or called by the output-feedback synthesis function. 
Furthermore, in the absence of commercial H.~ synthesis tools for discrete time, a 
measurement-feedback code was written, based on Riccati methods. It was helpful 
both for assessing the feasibility of example problems, and also formed the structural 
basis for the mixed H2 / H. synthesis routine. This section consequently concludes 
with listings of both the discrete H,. and H2 / H, synthesis codes for measurement 
feedback controllers. 
1. Numerical Solution of the Discrete Time Full-Information Prob- 
lem 
This section outlines the development of the ellipsoidal design codes for the 
discrete mixed Hz / H, full-information controller synthesis problem. Recall from 
Theorem 3.5 that the problem can be expressed as a convex optimization problem: 


Minimize: 


poet WY, Wo)) c= 
fi {(CoY + Doo ia) = (Gos + Doo Wy)? + (Do: + Dorh2)( Doi + Dork)" $ ’ 


(A.7) 
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Subject to: Y > 0, and L(W,Y, A2) < 0, 


where 


L(W,Y, K2) := 
AY BW eee, | Aye le 
CLY + DyowW Cy y¥o+ DoW 


+| Bre lei || By + Boy | -|* |. (A8) 


Dy, + Dio Dy, + Dygl\2 0 / 


and f; is the trace, fg is the maximum eigenvalue, or f3 is the maximum diagonal 
element. 

The structure of the code is very similar to the continuous codes above. 
Two items are of significance which warrant independent discussion. T*irst of all, the 
structure of the controller is different for the discrete problem, in that it is now a full- 
information feedback gain matrix, rather thai state-feedback. The parameterization 
of the controller is now Wy; = [WY7! W2], necessitating that the search has an 
additional p x q degrees of freedom, where p := dim (w) and q := dim (u). A set of 
basis matrices Ay, € R?*? was consequently constructed with identical structure as 
the set of W; above. The second, and more challenging issue was the determination 
of an initial feasible controller. This was necessary in order to assess the feasibility 
of the problem and to give the iterative ellipsoidal search a good starting point. To 
this date, no commercial codes are available to solve the discrete time #. Riccat 
equations, and so considerable effort was devoted to cleanly solving these problems. 


The codes for these problems are included lere as subroutines to the main script. 


1. Determine if the AH. problem is feasible, and determine a particular feasible 
controller A, = [4,, WN2,]. This was done by solving the discrete time He 


synthesis equation [Ref. 31]. 


lo 


6. 


=] 


10. 


. Determine ¥, and W, = A,}; from the H, analysis equation (3.2). 


Initialize the search at r = |0,..., O]?, with a very large ellipsoid about x. 


Fromaz, determine Y, W’, and /v2 as perturbations of the particular solution 


(W,,¥,,K2,). 


Evaluate the constraint @)(2) = Amar(—)) < 0. If @:(27) > 0, then use the 
eigenvector associated with the maximum eigenvalue to calculate the subgradi- 


ent: g, = 24). Update the ellipsoid and x and return to step 4. 
Or [ 


Evaluate the constraint @2(2) = Amar(L(W.Y, 42)) < 0. If da(a) > 0, then 


use the eigenvector associated with the maximum eigenvalue to calculate the 


O$2(zr 
2 


subgradient: gz = —J-~. Update the ellipsoid and ¢ and return to step 4. 


With both constraint functionals satisfied, evaluate the objective function y(1) = 


f(W.Y. W’2)) and its subgradient: g3 = wee) Update the ellipsoid, a, and the 


upper and lower bounds on the estimate of the optimum cost. 
Return to step 4 unless the termination criteria is satisfied. 
Calculate the (sub)optimal controller 4 = [WY 7! Wy]. 


Exit. 


The discussion above in section B, regarding computational issues. 1s also 


germane to these codes. 


The analytical expressions for the subgradient expressions are derived be- 


low. Recall that wu is the eigenvector associated with the maximum eigenvalue. The 


first subgradient g; is omitted since it is identical to the continuous time problem. 


Due to the structure of L(W,Y, A’2), it is easiest to break the gradient expression for 
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g2 into its respective parts. Additionally, the replacement Ay = WY! is made when 
convenient. 
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The subgradient for the cost. functional will first be derived for fz, and then 
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modified as above: 
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The gradients of fi(W.Y,W2)) and fa(VV.Y, 2) are then minor modifications [Ref. 
29]. For fi, replace u*u with the identity matrix J. For 3, replace u with the 
elemental vector é; = [0)....,0,1, 0.4... 0}, where the unit digit corresponds with the 
position of the maximum diagonal element. 
2. Discrete Time H2 / H. Full-Information Controller Synthesis Codes 

This section lists the discrete mixed H2 / Hx state-feedback controller 
design codes. The function dh2infsyni is the principal script. The function 
h2infform is an administrative script that maps the vector r into W, Y, and Wy. 
The functions dfiric2 and dhinfric solve the discrete 7. synthesis and analysis 
Riccati equations. Finally, the functions subgrad1, subgrad2, and costgradic cal- 
culate the subgradient vectors for the two constraint functionals and the cost function. 


Note that subgrad1 is identical to its continuous time counterpart and is included 


here sunply for completeness. The coding of the subgradients was the difficult part of 
the development, and the codes were validated (and the multiple errors corrected) by 


comparison with gradient vectors which were determined by brute force perturbation 


methods (1.e., g; = Leet ir) where e; = [0,...,0,1,0,... OVE ye 


dh2infsynl 


function [K,Kp,X,E,count,Psii,Psi2,outcome,time]=... 
dh2infsyni(f,pd,Dim,Sf,mitr,exit,Xi,Ei,counti,Psili,Psi2i) 


% function ([K,Kp,X,E,count,Psi1,Psii2,outcome,time]=... 
if dh2infsyni(f,pd,Dim,Sf,mitr,exit,Xi,Ei,counti,Psiii,Psi2i) 


% Finds full information feedback gains for DISCRETE (sub)optimal mixed h2/hinf 
% control. Solves for appropriate fi gains with which to build output feedback 
% controller if input ’pd’ is auxiliary plant. 

% Hinf constraint is applied as infnorm(Tziw)<1. Different values of gamma 

% must be absorbed into the appropriate rows of the plant matrix. 


% Inputs: 

% Method of evaluating generalized mixed h2/hinf cost function can be selected: 
4 f=1(trace), 2(max eigenvalue), or 3(max diag element) 

% System matrix ’pd’ must be a packed mu-tools system matrix,with the noted 

% dimensions: 


4, Dim(1) Dim(3) Dim(2) 

h | AA | Bi B2 | 

vA pd= | co | DO1 DO2 | 

h | C41 Peet Di2 | Dim(4) 

h 

4% Note: the columns and rows associated with the input w and the output z1 
vA must have been scaled for gamma=1 

% ’Dim’ holds the descriptions of the problem size: 

i Dim(5)=sdof=Dim(1)*(Dim(1)+1)/2 + Dim(2)*(Dim(1)+Dim(2) ) 

4, °?Sf’ is the filtering cost matrix for the output feedback problem and 
yA should be set to zeros(nstates) for full info feedback problem 


% °mitr’ is the max number of iterations 

4% ’exit’ is the exit criteria as fraction of the cost 

4% The remaining input variables are for restarting a problem that had not yet 
vA reached convergence and should be empty for initialization. 


% The outputs are the gain matrix K=[K1,K2], the central controller Kp, and the 
4, stopping parametrics which provide for restart capability if the problem had 


% not yet converged. ’outcome’ identifies the termination branch followed. 


% Constraints are applied using the formulation of Thm 4.3 from Kaminer, 
% Khargonekar and Rotea. This is the TWO STEP contraint. 
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% This version uses MATLAB’s ’eig’ to evaluate positive definiteness 


Atime=cputime; 
outcome=’max iterat’; 


% unpack system matrices 
[AA,B,C,D]=unpck(pd) ; 


sdof=Dim(5); nstates=Dim(1); 

pdist=Dim(3) ; routput=Dim(4) ; tt=row(C); pq=Dim(2)+pdist; 
Bi-BG., 1: pdist.) ; B2=B(: ,pdist+1:pq); 

CO=G(1 (tt-routput) ,:); Cl=COCLCareutput+,) tt, ): 


BOl=DC1:(tt-routput) ,1:pdist); 
Dii-b((tc-routputt+1):tt,1:pdist); 
DO2=D(1:(tt-routput) ,pdist+1:pq); 
Di2—-pC(tte-routputtl) :tt,pdist+1:pq) ; 


% Determine feasibility and specific solution (central controller) 
% Solve the synthesis Riccati equation 
(Kip,K2p,P,Perr, erflg}J=dfiric2(AA,B1,B2,C1,D11,D12,0.99); 
if erflg>1, 
outcome=’INFEASIBL1’; return 
end 
Kp=(Kip,K2p]; 
% Solve the analysis equation 
([Yp,erflgJ=dhinfric((AA+B2*Kip)’,(C1+D12*Kip)’, (B1+B2*K2p)’,(D11+D12*K2p)’ ,0.99); 
if erflg>0, 
outcome=’INFEASIBL2’; return 
end 
Wp=K1p*Yp; 


% Initialize problem or use last value? 

% This is a weak point in the code right now as it initializes the ellipsoid 

4% as something arbitrarily huge. Need to find a way to initialize the ellipsoid 
% in a smarter way. 


Gount=—L0 0 0): Psii=inf; Psi2=0; thresh=0; 
X=zeros(sdof,1); E=100*eye(sdof ); 
if nargin>6, 

count=counti; Psii1=Psili; Psi2=Psi2i; 

X=Xi; E=Ei; 


elseif nargin<6, 

error(’insufficient number of input arguements’ ) 
end 
Z=zeros(nstates,routput) ; gam=1; 


foe K=1:imitr, 
(W,Y,K2)=h2infform(X,Wp,Yp,K2p,Dim) ; % maps X to (W,Y,K2) 


% Enforce Y>0 
[Vy ,Ey]=eig(-Y); 
([Phi1,index1]=max(diag(Ey) ); 


If )Phi1>07 
g=subgradic(Vy(:,index1) ,nstates ,sdof) ; 
Eg=E*g; gag=sqrt(g’*Eg); Eg=Eg/gag; 
if Phil>gAg, 

outcome=’indefinite’; return 
end 
alpha=Phii/gAg; 
count=count+[1 0 0]; 


% Enforce infinity norm constraint 
else, 
Ki=W/Y; 
a= [AA+B2¥*K1;C1+D12*K1]; 
b=(B1+B2*K2;D11+D12*K2] ; 
L=a*Y*a’+b*b’-[Y,Z;Z’ ,eye(routput) J; 
(Vinf ,Einf]=eig(L); ([Phi2,index]=max(diag(Einf) ) ; 
if Phi2>thresh, 
g=subgrad2(K1,K2,Vinf(:,index),Dim,AA,B2,C1,D12,a,b); 


Eg=E*g; gAg=sqrt(g’*Eg) ; Eg=Eg/gag; 
if Phi2>gag, 

outcome=’infeasible’; return 
end 


alpha=Phi2/gAg; 
count=count+[0 1 0]; 


% Given above are satisfied, follow cost gradient 


else, 
(Psi, gl=costgrad(f,¥,K1i,K2,€0), B01, D02, Dim, st); 
Eg=E*g; gag=sqrt (g’*Eg) ; Eg=Eg/gag; 


Psi2=max([(Psi-gAg) ;Psi2]); 
if Psi<Psil, 

Psii=Psi; alpha=0; 
else 

alpha=(Psi-Psil1)/gag; 
end 
count=count+[0 0 1]; 


4 Exit criteria 
if gAg<exit*Psil, 
disp(’Program converged to solution’) 
outcome = ’converged!’; break 
end 
end 
end 
X=X-Eg*((1+sdof*alpha)/(sdof+1)); 
E=E-2*Eg*(Eg’*((1+sdof*alpha)/(sdof+1)/(1+alpha) )); 
E=E*((1-alpha*2)*sdof~2/(sdof~2-1)); 
E=(E+E’)/2; % enforce symmetry 
end 


7time=cputime-t ime; 
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1f outcome == ’converged!’, 
K=(K1 K2]; 
end 


4 Following are called non-organic functions: 

”% function (W,Y,K2)=h2infform(X,Wp, Yp,K2p,Dim) 

% function gi=subgradi(vi,nstates,sdof) 

% function g=subgrad2(K1,K2,Vinf(:,index),Dim,AA,B2,C1,D12,a,b); 
% function [Psi,g]=costgrad(f,Y,K1,K2,C0,D01,D02,Dim,Sf); 

% function Sys=pck(a,b,c,d) from mu-tools toolbox 

7%, function (Fi,b2,P,Perror,ertigiodtiric2¢a,81,82.C,D11,D12, gam); 
% function ([Yp,erflgJ=dhinfric(F,G,H,J,gam) ; 


% end dh2infsyn1 


dfiric? 
imetion (F1,F2,P,Perror,erflg]=dfiric2(A,B1,B2,C,D11,D12,gam) ; 
if [F1,F2,P,Perr,erflg] = DFIRIC2(A,B1,B2,C,D11,D12, gam) ; 


4 This routine solves the Discrete Algebraic Riccati equation 

4 for the full information h-infinity problem: 

% Find a P such that: 

% VCP) = B2’PB2+D11’D11 > 0 

4% R(P)=gam"2*I-D11’D11-B1’PB1+(B1’PB2+D11’D12) *inv(V(P) )*(B1’PB2+D11’D12)’>0 


A and the DARE: P = A’PA + C’C - Xb*inv(G(P))*Xb’ 

ik 

yp is satisfied with: 

vA GP) = [.D11°D1it + Bi’ Pei= gam™~ 2] Dil DiZ2y+2Bl Pao = 
ia Di2* Dili + B2’ PBI D12’D12 + B2’PB2 } 
yf KDo = “A P(B1 B2]4C* (D171 Di2): 

i 


% where u(k) = (F1,F2)*(x(k)’ w(k)’J’ the solution to the full information 

4% case. The solution is based on Iglesias’ symplectic pencil formulation. 

% WARNING: The input argument order is different from Stoorvogel’s’dfiric’ to 
% make the formulation consistent with Rotea and Kaminer’s notation. 


4 The following inorganic matlab functions are called: 
fected chk2 


fpegin dfiric2 
erflg=0; 
h CHECK THE CONSISTENCY OF THE MODEL MATCHING PROBLEM 


[m1 ,n,p,msg1]=abcdchk2(A,B1,C,D11) ; 


(m2,n,p,msg2) =abcdchk2(A,B2,C,D12); 


if ~“(isempty(msg1) & isempty(msg2)), 
disp(’ERROR IN THE REALIZATION’); 
disp(msg1) ,disp(msg2) 
erflg=2; 
return; 

end 


Ip=eye(m1); Ir=eye(p); In=eye(n); 
Zn=zeros(n) ; 


Ri=inv((D1i1’*Dii-Ip*gam"2, D1i1’*D12; D12’*D11, D12’*D12)); 


% symplectic pencil for DARE: 


SINFi=[ A-(B1 B2])*Ri*(D1ii D1i2])’*c, Zn 
-C’*(Ir-[Di1 Di2}*Ri*[Dii Di2]’)*c, In J]; 
SINF2=[ In , (Bi B2]}*R1*(Bi B2]’ 
Zr (A-(B1 B2])*Ri*(D11i D12]}’*C)’]); 


(Vs,Ts]=eig(SINF1,SINF2) ; 
Ts=diag(Ts); 


if min(abs(log(abs(Ts))))<(10000*eps), 
disp(’Hamiltonian is not in dom(Ric)’), 
erflg=3; 
return 
else, 
indexi1=find(abs(Ts)<1); 
P=Vs(n+1:2#n,index1)/Vs(1:n, index1); 
P=real(P); 
P=(P+P’)/2; % Ensures P=P’ 
end 


4 Verify accuracy of solution 
GP=inv(inv(R1)+({B1i B2]’*Pp*[{B1 B2)); 
Xb=A’*P*(B1 B2)+C’*(Dii1 D1i2]; 

Perror= A’*P*A - P + C’*C - Xb*GP*Xb’; 


accuracy=(norm(Perror)/norm(P)); 

if accuracy>1e-6, 
disp(’ Warning: Solution to DARE may be inaccurate’) ; 
accuracy 
erflg=1; 

end 


% Check for stability 

Acloseloop=A-[B1 B2]*GP*Xb’ ; 

if max(abs(eig(Acloseloop)))>=1, 
disp(’Closed loop system not stable’) 
erflg=4; 
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return 
end 


VPi = pinv(B2’*P*B2+D12’*D12); 
F1 = -VPi*(B2’*P*A+D12’*C) ; 

F2 = -VPi*(B2’*P*Bi+D12’*D11); 
return 


yosend dfiric2 


dhinfric 
function [Y,erflgJ=dhinfric(F,G,H,J,gam) ; 


VE CY, erflgjJ=dhinfric(F,G,H,J,gam) ; 

vf 

% This routine solves the Hinf Discrete Algebraic Riccati equation for a closed 
% loop system F,G,H,J. 


%, Find a Y such that: 
% R= gam72*I - J’*J - G’*Y¥*G > 0 
%  FYF’ - Y + GG’ + (FYH’ + GJ’)*R\CHYF’ + JG’) = 0 


% The solution is based on Iglesias’ symplectic pencil formulation (eqn 2.6) 
% Calls chol2 and row from ktools 


[n m]=size(G); 
R=gam~2*eye(m)-J’*J; F=F+G*(R\J’)*H; 


7% form Symplectic pencil 

Si=(F zeros(n,n); -H’*inv(eye(row(J))-J*J’)*H eye(n)J; 

S2=[Leye(n) -G*(R\G’); zeros(n,n) F’]; 

[Vs,Ts]=eig(S1,S2); Ts=diag(Ts) ; indexi=findvabs(1s) <1): 


if min(abs(log(abs(Ts))))<(10000*eps) , 
erflg=1; return 
end 
Y=real(Vs(nt+1:2*n,index1)/Vs(1:n,index1)); V=(7141")/ 2: 
if (chol2(Y,n)~=1) | (chol2((R-G’*Y*G) ,m)~=1), 
erflg=1; return 
end 
erflg=0; 


%, end dhinfric 


h2infform 


function (W,Y,K2)=h2infform(X,Wp,Yp,Khinf2,Dim) 


4% reformats the space X in Rs to the three matrices 
% X is assumed to be comprised of the diagonal rows of Y, starting with the 
% main diagonal, followed by W in column order, and lastly by K2 by column 


nstates=Dim(1); qcontrol=Dim(2) ; pdist=Dim(3) ; sdof=Dim(5); 


j=nstates; 

Y=Ypt+diag(X(1:nstates)); 

for k=i1:nstates-1, 
l=nstates-k; 
Y=Yt+diag(X(j+1:j+i),k)+diag(X(j+1:j+i) ,-k); 
j=jt1; 

end 


W=Wp+reshape(X(j+1:jt+nstates*qcontrol) ,qcontrol,nstates) ; 
K2=Khinf2+reshape(X(j+tnstates*qcontrolt+i:sdof),qcontrol,pdist) ; 


7, end h2infform 


subgrad] 
function gi=subgradi(v,nstates,sdof ) 
4% calculates subgradient for first constraint function Y>0 


gi=zeros(sdof,1); 
k=1; 


for i=1:nstates % counts out diag rows 
for j=1:nstatest1-i % counts down diag rows 
if 1==1, 
gi(k)=-v(j)*v(j); 
else, 
g1(k) =-2*v(j )*v(j+i-1); 
end 
k=k+1; 
end 
end 


7% end subgrad1 


subgrad2 


function g2=subgrad2(K1,K2,v2,Dim,AA,B2,C1,D12,a,b); 
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”% Uses analytical expression for subgradient 
% See page 16 of journal 
nstates=Dim(1); qcontrol=Dim(2) ; pdist=Dim(3) ; sdof=Dim(5) ; 


ab=a’*v2; 
ac=ab*(v2’*[AA;C1)); 
bd=(v2’*(B2;D12)); 
Sy=actac’-ab*ab’; 
Sw=ab*bd; 

Sk=(b’*v2) *bd; 


k=1; 
g2=zeros(sdof,1); 


for i=i:nstates % counts out diag rows 
fon j)—1:nstatest+1-1 % counts down diag rows 
if 1==1, 
E2 wJESy(), j)-v2(k) 2; 
else, 
Bea) =Sy(], 11-1) 45y 0) ti 1, Je 2ev 2) 424 41-1); 
end 
k=k+1; 
end 
end 


g2(k: (k+qcontrol*nstates-1))=2*reshape(Sw,qcontrol*nstates,1); 
g2((k+qcontrol*nstates) :sdof)=2*reshape(Sk,qcontrol*pdist,1) ; 


% end subgrad2 


costgrad 

function (Psi3,g3]=costgrad(f,Y,K1,K2,C0,D01 ,D02,Dim,Sf) 

% function (Psi3,g3]=costgrad(f,Y,K1,K2,C0,D01,D02,Dim,Sf) 

7% FOR USE WITH DH2INFSYN 

% computes the cost function for the mixed H2/Hinf discrete time 


% input argument f selects which of the 3 generalized costs is to be 
% implemented: 


h 1= trace 
yA 2= max eigenvalue 
vA 3= max diagonal entry 


4% also determines the subgradient for the cost 
% calls row (ktools) 


sdof=Dim(5); nstates=Dim(1): qcontrol=Dim(2) ; pdist=Dim(3) ; 
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dk1=D02*K1; 
a=CO+dki; 
b=D01+D02*K2; 
M=a*Y*a’+b*b’+Sf; 
if f==i, 
Psi3=trace(M) ; 
RY=CO’? *CO-dki’*dki; 
RW=2*D02’ *a; 
RK2=2*DO2’ *b; 
else, 
if f==2, 
(V3,E3]=eig(M); 
(Psi3,index]=max(diag(E3)); v=V3(:, index); 
elseif f==3, 
([Psi3,index]=max(diag(M)); v=zeros(row(M),1); v(index)=1; 
else, 
error(’first input argument must be 1,2,or 3’) 
end 
a=CO’*v; 
d=D02’*v; 
dki=d’*Ki; 
RK2=2*d*(v’?*DOit+td’*K2) ; 
RY=a*a’-dki’*dki; 
RW=24d*(a’+dki); 


end 
k=1; g3=zeros(sdof,1); 
for i=i:nstates % counts out diag rows 
for j=i:nstatesti-i 7% counts down diag rows 
if i==1, 
g3(k)=RY(j, 5); 
ere, 
g3(k)=2*RY(j,j+i-1); 
end 
k=k+1; 
end 
end 


g3(k: (k+qcontrol*nstates-1))=reshape(RW,qcontrol*nstates, 1) ; 
g3((k+qcontrol*nstates) :sdof )=reshape(RK2,qcontrol*pdist,1); 


% end costgrad 
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3. Discrete H,. Output-Feedback Controller Synthesis Problem 

The following design code was prepared to solve the discrete H., output- 
feedback controller synthesis problem. In the absence of commercial codes to solve 
this problem, this code was useful to assess the feasibility of synthesis models prior 
to attempting the mixed Hz /H. problem. Specifically, the value of achievable 
y for the HH. controller was a measure of the degree of freedom available to the 
Hy optimization. The #,, problem ts solved by solution of the filtering equation by 
Iglesias’ symplectic pencil method [Ref. 47], and then construction of an auxiliary 


plant per Stoorvogel [Ref. 31]. 


dhinfsyn 


function [k,gfin]=dhinfsyn(pd,qcontrol ,moutput, logam,higam, tol) 
% function (k,gfin]=dhinfsyn(pd,qcontrol,moutput,logam,higam,tol) 
% Determines discrete time controller which minimizes the infinity 


% norm of w to z (to within the specified tolerance). 
% The discrete system P is partitioned (per mu-tools): 


Ir Pao eb b2 | 
vi p = heed” <add’. sai". 
i} eMeDs dt edt | 


% where b2 has column size of the number of control inputs (qcontrol) 
% and c2 has row size of the number of measurements (moutput) being 
% provided to the controller. 


% dhinfsyn calls dfiric2, row, col (personal codes) and unpck from mu-tools 
4% toolbox 


(AA,BB,CC,DD]=unpck(pd) ; 


nzi=row(CC)-moutput ; nwl=col(BB)-qcontrol; 

Bi=BB(: ,1:nwi); B2=BB(:,nwit+1:col(BB)); 
Cr=CCCl-nz1.:): C2=CC(nzl+1: rowlco)..)- 
D11=DD(1:nz1,1:nwi): D12=DD(1:nz1,nw1i+1:col(BB)); 
D21=DD(1i+nz1i:row(CC) ,i:nwi); D22=DD(1+nz1:row(CC) ,nw1+1:col(BB)); 
gamil=higam; gam2=logam; gam=gam 1 ; 


Ia=eye(D11*D1i1’)-D11*D11’; 


while (gami-gam2)/gam1>tol, 
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4% solve the filtering equation 
[L1,L2,Q,Qerror,erflgiJ=dfinic2( Ak’ ,C1",C2” Bl” Did ebaieeoam:, 
if erflgi<=1, 

% Build Gfi(Q), the augmented plant 

V=C2*Q*C2’+D21*D21’; 

R=Ia-C1¥*Q*C1’+C1#Q*C2’*(V\C2*Q*C1’); 

Z=AA*Q*C1’+B1i*D1i1’-(AA*Q*C2’+B1i*D21’)*(V\(C2*Q*C1’+D214%D11’)); 

Vhalf=inv(sqrtm(V)); 

Rhalf=inv(sqrtm(R)); 


AAg=AA+Z*(R\C1) ; 
Big=(AA*Q*C2’+B1*D21’°+Z*(R\(C1*Q*C2’+D11*D21’)))*Vhalf; 
B2q=B2+Z* (R\D12); 

Ciq=Rhalf*C1; 

Diiq=Rhalf*(C1*Q*C2’+D11¥*D21’)*Vhalf; 

D12q=Rhalf*Di2; 


% Now solve for the full-info gains which satisfy the hinf prob 
(Kia,K2a,P,Perror, erflg2]=dfiric2(AAq,Biq,B2q,Ciq,D11q,D12q,gam) ; 
if erflg2<=1, 
gami=gam; 
gam=(gamt+gam2)/2; disp(gam) 
end 
end 


if max((erflgi; erflg2] )>=1, 
if gam==higan, 
error(’problem not feasible within specified gamma range’ ) 


end 

gam2=gam ; 

gam=(gam+gami)/2;  disp(gam) 
else, 

K1i=Kia; K2=K2a; 
end 


end 


% Build hinf controller 
Ac=AAqt+B2q*K1-(B1q+B2q*K2)*Vhalf*C2; 
Bc=(B1q+B2q*K2)*Vhaltf ; 
Cc=K1-K2*Vhalf*C2; 

Dc=K2*Vhalf; 

Kk=pek(Ac,Be.Ce De); 

gfin=gam1; 


% end dhinfsyn 
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4. Discrete H, / H,, Output-Feedback Controller 
The following function file solves the discrete Hy / H~. output-feedback 
controller synthesis problem. It is based upon the optimal discrete H. code above 
and differs principally in that after the auxiliary plant is constructed it calls the 
dh2infsyn to solve the mixed full-information state-feedback controller problem. As 
with the continuous codes, w and z are assumed to have been scaled in order that 


the constraint || 72, |lo< 1 1s feasible. 


dh2infsyn 


function [K,count,Psil,Psi2,outcome,time]=dh2infopfb(f,pd,Dim,mitr,exit) 


% Finds full information feedback gains for DISCRETE (sub)optimal mixed h2/hinf 
% control. Solves for appropriate fi gains with which to build output feedback 
% controller if input ’pd’ is auxiliary plant. 

% Hinf constraint is applied as infnorm(Tziw)<1. Different values of gamma 

%4 must be absorbed into the appropriate rows of the plant matrix. 


2 inputs: 

4 Method of evaluating generalized mixed h2/hinf cost function can be selected: 
4% f=1(trace), 2(max eigenvalue), or 3(max diag element) 

% System matrix ’pd’ must be a packed mu-tools system matrix,with the noted 

4 dimensions: 


i Dim(1) Dim(3) Dim(2) 

%, p = | AA | Bi B2 | 

ip lecory ([ 2po1 DO2 | 

vA lisea \) “Dad D12 | Dim(4) 
i | C2 [ays D22 | Dim(5) 


7, Note: the columns and rows associated with the input w and the output 21 
vA must have been scaled for gamma=1 

% ’mitr’ is the max number of iterations 

% ‘exit’ is the exit criteria as fraction of the cost 


%  OQutputs: 

%  K- dynamic controller in packed (mutools) form 

% count- iteration breakdown on ellipsoidal routine 
%  Psii,Psi2- upper/lower bounds for mixed cost 


%  dh2infopfb calls dfiric2, row, col (personal codes) and unpck from mu-tools 
7%, toolbox as well as d2hinfsyn and its subroutines 
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% unpack system matrices 
(AA,B,C,DJ=unpck(p) ; 


nstates=Dim(1); qcontrol=Dim(2); pdist=Dim(3) ; 
routput=Dim(4) ; moutput=Dim(5); 
noutO=row(C)-routput-moutput ; pq=Dim(2)+pdist; 
tt=row(D)-moutput; 

BI=B(?;1-paist), B2=B(: ,pdist+1:pq); 
CO=C(1:noutO,:); C1=C((nout0+1) :noutO+routput,:); 


C2=C((noutOt+routput+1):row(C),:); 
DO1=D(1:nout0O,1:pdist); 
D11=D((tt-routput+1):tt,1:pdist); 
D21=D((noutO+routput+1):row(C),1:pdist); 
DO2=D(1:(tt-routput) ,pdist+1:pq); 
D12=D((tt-routputt+1):tt,pdist+1:pq); 
D22=D((noutO+routputt1) :row(C) ,pdist+1: pq); 


gam=1; 
Ia=eye(D11¥*D11’)-D11*D11’; 


4% solve the filtering equation 
([L1,L2,Q,Qerror,erfilgi]=dfiric2(aan’ ,C1°,C2°, Bl ( DitueD2 ia can): 
if erflgi<=1, 


% Build Gfi(Q), the augmented plant 

V=C2*Q*C2’+D21*D21’; 

R=ITa-C1*Q¥*C1’?+C1*Q*C2’*(V\C2*Q¥*C1’); 
Z=AA*Q*C1’+B1*D11’?-(AA*Q*C2’+B1*D21’ )*(V\(C2*Q*C1'°+D21¥*D11’)); 
Vhalf=inv(sqrtm(V) ); 

Rhalf=inv(sqrtm(R)); 


AAQ=AA+Z*(R\C1) ; 
B1q=(AA*Q*C2’+B1*D21’+Z*(R\(C1*Q*C2'+D11*D21’)))*Vhalf; 
B2q=B2+Z*(R\D12) ; 

DO1ig=(D01*D21’+CO*Q*C2’)*Vhalf ; 

Ciq=Rhalf*Ci; 

D1iq=Rhalf*(C1*Q#*C2’+D11¥*D21’ )*Vhalf; 

Di2q=Rhalf*D12; 


pq=pcek(AAq, [(B1q,B2q] ,(CO;Ciq] , (D01q,D02;Diiq,D12q)); 


% compute the filtering cost 
Sf=CO*Q*C0+D01*D01 ’-D01q*D01q; 


% Now solve for the full-info gains which satisfy the hinf prob 
(Kfi,Kp,X,E,count,Psi1,Psi2,outcome,time] =dh2infsyni(f,pq,Dim,Sf,mitr,exit) ; 


K1=Kfi(:,1:nstates) ; K2=Kfi(: ,nstatest+i:nstatestpdist) ; 


else, 
error(’Filtering equation infeasible’ ) 
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return 
end 


io08ui1d controller 
Ac=AAqt+B2q*K1-(BigtB2q*K2)*Vhalf*C2; 
Bc=(B1q+B2q*K2) *Vhalf ; 
Cc=K1-K2*Vhalf*C2; 

Dc=K2*Vhalf; 

Kk=pck(Ac,Bc,Cc,Dc); 


% end d2hinfsyn 


D. Validation of the Ellipsoidal Codes 


While the ellipsoidal algoritlini itselfis very simple, the complexity of the deriva- 
tion of the gradients and their translation into code was a fertile ground for mistakes. 
Means were consequently required to validate the results. Two methods were used to 
test their validity. First of all, Rotea presents results for an example problem in [Ref. 
29] where an ellipsoidal algorithm was used to determine a measurement-feedback 
controller by soliving the generalized HH syuthesis problem . In coding the gener- 
alized mixed H2 /Hi problem, a generalized H2 algorithm was first written. These 
results matched Rotea’s data exactly. This #2 code was then modified slightly to 
accomodate the #4, constraint. ‘Testing the satisfaction of this constraint on the 
final output was built directly into the termination criteria for the code. Secondly, 
each gradient subroutine was verified by calculating the gradient at multiple random 
points in the search space both using the subroutine aud by a brute force differencing 
method. This comparison was very successful in finding errors in either the coding 


or in the original derivations. 
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APPENDIX B:CONTROLLER DESIGN 
EXAMPLE SCRIPTS 


This appendix documents the MATLAB scripts and simulink models that were 
used for the design and analysis of the autoland controllers in Chapter IV. The model 
used for both controllers was identical, and a single script prepared both synthesis 
models in order to ensure that the designs were for identical systems. Consequently 
several of the sections pertain to both designs. The first section presents the simulink 
models and the equation of motion function file from which the linearized models 
were extracted and which were used during the analysis. It also includes the scripts 
which established the linear synthesis models. The second section includes the scripts 
used to perform the state-feedback and measurement-feedback design for the He 


controler. The third section includes the scripts which were used to design the mixed 


H, | He, controller. 


A. NONLINEAR MODELS 
1. Equation of Motion 
The following equation of motion script was used at the core of all the 
nonlinear models to perform the calculation of the state derivatives. Since the F- 
14 design problems were limited to longitudinal axis glideslope tracking problems, 
only the longitudinal states are considered. The requirement to perform robustness 
analysis and design also required the inclusion of uncertainty inputs and outputs 
in the equations of motion. These terms are reflected in the variables delta_in 


and delta_out. The stability derivative data was extracted from [Ref. 48] for a 
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flight condition of 134 KIAS and 11.7 degrees in the power approach configuration. 
Because the control power derivatives for the DLC were unavailable, it was scaled 
to produce 0.1lg of vertical acceleration, and 0.01g of horizontal deceleration at a 
deflection of 0.5 rad. True states were calculated internal to the equations of motion. 
and perturbation states were therefore integrated exterior to the equations of motions. 
This architecture simplified simulation and trimming, since all signals external to the 
equations of motions were perturbation states. The trimmed lift and drag coefficients 
were adjusted from their handbook values because they were slightly inconsistent 
with the values necessary to trim the model at the specified thrust and weight. 


eom4 


function statedot=eom4(state) 
4 determines continuous time state derivative for nonlinear longitudinal 
4% equations of motion. 


% This version all states read in are the perturbation states 


% flight condition: 


g=32.174; % fps 

m=54000/¢; “% slugs 

lyy=247194; Ansiug—-ft «2 

S=565 ; i Ags ae 

cbar=9.8; htt 

alphaT=0; % thrust incidence (radians) 
20-0). % thrust couple 
VO=134*1.6889; “4 fps 

rho=.002376; io slug/it 3 
alpha0=11.4/57.3; 4, rad 

thetaO=alpha0; % rad - trim point is level flight 
TO=13118; % lbs 


4%, F-14 derivatives 

CDt=0.37405269; %, trimmed coefficients (these differ from handbook) 
CLt=1.49534913; 

Cmt =O; 

CDU=0; 

CLU=0; 

CMU=0; 

CDA=0 .0208*57.3; % rad*-1 

CLA=0.0799*57.3; “4 rad~-1 
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CMA==0- O15 "S73: 4 rad —1 


CDQ=0; 

CLQ=5.45; % rad--1 
CMQ=-14.3; % rad"-1 
CDAD=0; 

CLAD=-0.51; % rad~-1 
CMAD=-0.93; 4 rad"-1 
CDIS=0; 

CLIS=0.0141*57.3; 4 fad=-1 
CMIS=-0.0201*57.3; % rad*-1 


% the DLC control power is scaled to permit .1g at full deflection of .5 radians 
CLDLC=0.1*CLt/(0.5); 

CDDLC=0.1*CLDLC; 

CMDLC=0 ; 


7%, Unpack perturbation states 
du=state(1): 
dalpha=state(2); 


q=state(3); 

dtheta=state(4); , 

stab=state(5); % These are perturbation deflections 
dT=state(6); 

DLC=state(7); odatte 


delta_in=[state(8);state(9);state(10)]; 


% Calculate true states 
u=(dut+tcos(alpha0))*V0; 
alpha=dalphatalpha0O; 
theta=dthetattheta0; 
T=TO+dT ; 


% Calculate the dynamic pressure 
V=u/cos (alpha) ; 
Q=0.5¥*rho*V" 2; 


% following matrix incorporates both fixed constants and rotation from stab 
4% axis to body axis 

Rwb=[-cos(alpha) sin(alpha) 0;-sin(alpha) -cos(alpha) 0;0 0 1]; 

Row=Rwb’; 

QT=Q*S*(-cos(alpha) sin(alpha) 0;-sin(alpha) -cos(alpha) 0;0 0 cbar]; 


% LHS comprises mass matrix and alphadot aero forces 
LHS=diag([m*VO ,m*V,Iyy] )-QT*(cbar/2/V)*(CDAD CLAD CMAD]’*(0 1 0]; 


4% Determine coupling term (body axes) 
Fcouple=m*q*(-sin(alpha)*V; u; 0]; 


4 Determine gravity term (body axes) 
Fgrav=m*g*[-sin(theta); cos(theta); 0]; 
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7, Determine thrust term (body axes) 
Fthrust=T*[(cos(alphaT); sin(alphaT); zT]; 


% Build aero forces in stability axes and then rotate to body axes 
iram=vept, CLt: 0]; 

Derv=(CDU*VO CDA CDQ; CLU*VO CLA CLQ; CMU*VO CMA CMQ]; 

CPower=(CDIS CDDLC; CLIS CLDLC; CMIS CMDLC]; 


Faero=QT*(Trim+Derv* (du; dalpha; q*cbar/2/V]+CPower*(stab; DLC]+ delta_in); 
delta_out=Derv*(du;dalpha;q*cbar/2/VJ]+CPower*[stab; DLC]; 


statedot1=LHS\(FcoupletFgrav+Fthrust+Faero) ; 

thetadot=q; 

gamma=theta-alpha; 

wdot=statedot1(2)*V; 

hdot=sin(gamma)*V/VO; % Note that hdot is scaled by velocity 


statedot=([statedoti;thetadot; hdot; wdot; V;delta_out]; 


% end eom4 


2. Openloop Simulink Model 
The open-loop simulink model from which the synthesis model was ex- 
tracted is presented in Figures B.1. 3.2. and B.3. The model includes the actuator 
niodels, as well as the appended integrators on the outputs of interest. As discussed 
in Chapter IV, additional integrators were required midway through the design pro- 
cess in order to achieve the desired tracking properties. These figures include the 
additional appended integrators. These models were not used for any simulation, but 
represented a graphical means of accounting for the paths of various signals through 
the system. 
3. Synthesis Model Construction 
The following script performed the function of extracting the lmear model 
and creating the state-space formulations for both the #. controller design and the 


mixed design. Beyond the linearization itself. the principal purpose of this script was 
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Figure B.2: Non-Linear Plant and Actuators Block 


to perform the necessary bookkeeping functions of collecting the appropriate channels 
into the appropriate inputs and outputs of the vectors w, z9, 2;, and y. Finally, some 
baseline scaling of the input and output signals was performed. The system matrices 
were then compiled in a p-tools system matrix format [Ref. 24] to be passed to the 
appropriate design codes. 

plant10c 

“% Establish synthesis plant for mixed controller and hinf design problem 

% This uses the f14 model extracted from fi4nlaero5S 

% This problem is a glideslope tracker with 

% with double integrators on DLC and alpha 

Delta=0.2*eye(3); 

taui=0.4; % power plant time constant (2.5 rad/s) 

tau2=0.05; % horizontal stab time constant (20 rad/s) 


taus=0.02: %, DLC time constant (50 rad/s) 
sigma_gam=3/57.3; ‘rad 


Li 


fo — 






cmd Damuxt h_er h_er/s 
alpha_er alphaer/s alphaer/s/s 
DLC_er DLC/s DLC/s/s 
= 
ae [ 
— > il 
i ae out_1 
y1 ae 
a 
Ss" 
Demux Mux 


y 1=hdot,h,alpha,q, thet, 
udot,wdot, V,OLC 


Figure B.3: Output Integrators Block 


U0=134*1 .6889; 


[AA,BB,CC,DDJ=linmod(’f14nlaeroS’); 

%, linmod orders states(14): 

i) h_er/s2,alphaer/s2,DLC/s2,u,alpha,q,theta,stab,T,DLC,h,alp_er/s,h_er/s,DLC/s 
% inputs: (21) 

he h_cmd,alp_cmd,DLC_cmd,13 noises,stabc,Tc,DLCc,del 1-3 

4 outputs (15) | 

% h_er/s2,alper/s,DCL/s,hdot ,h,alpha,q,theta,Nx,(Nz-1),V,DLC, 

¥/ stabcmd,Tcmd,DLCcmd,del1i-3 


% Requires plant be input in form: 


iE xdot= AA*x + Bitw + B2*u 
yh zZO= CO*x + + DO2*u 
yi zi= C1*x + + D1i2*u 
h y= C2*x + D2i*w 


4, ’a’ represents the full output feedback plant 
4% ’b’ is reduced statefeedback plant (noise columns stripped) 
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Bilaj=95(:. (1715.19: 21)): BAbSBE Cl 3249-21) B2=BB(: ,16:18); 
i, ***ee4e4eeee%%e%Bui]ld Pure Hinf Plant matrices ** ** #% 44% Kk KKK KKK OR OK 
4, Important: delta scaled by factor of .2 already 


4% z1: h_er/s,alper/s,DCL/s,stabcmd,Tcmd,DLCcmd, udot,alphadot ,qdot ,thetadot,hdot, 
vf del1-3 (14) 

@ta=@C0l1-3,13:15]),:):; #£aCl4:7,11],:); Cco(i16718,:)]; 

Dila=zeros(14,18); D1iib=zeros(14,6); 

Di2a=(DD( [1:3,13:16],16:18); B2([4:7,11],:); DD(16:18,16:18)]; 


% y: hier/s2,alper/s2,DCL/s2,h,alpha,q,theta,Nx,(Nz-1),V (10) 
C2-cecl!:3,.5:11]),:): 
D2 =0D(f1:3,5:11] ,(1:15,19:21]); D22=DD( [1-3.5 8111] -16013)> 


4 Pack mixed output feedback plant 
pnom_a=pck(AA, (Bia B2],(C1a;C2], (D11a,D12a;D21,D22]); 


4 Pack statefeedback plant 
pnom_b=pck(AA, (Bib B2],Cia,(D1iib Di2a]); 


% To scale outputs for hinf: zi- rows 14:27 
1p del are rows 25:27, and col 29:31 


Yo kkk KEKKKA KERR EKEKES Build Mixed Plant matrices + #426844 kk KOKORO KHOR OK Am 


% Important: delta scaled by factor of .2 already 


4% z0O: h_er/s,alper/s,DCL/s,stabcemd,Tcmd,DLCcmd, udot ,alphadot ,qdot ,thetadot ,hdot(11) 
ence ci!3,13:715),:): AgC14:7,11),:)): 

DO1ic=zeros(11,18); DO1id=zeros(11,6); 

Doe fhNC(1:3,13:15),16:18); B2¢14:7,11],:)); 


4% z1: h_er/s,alper/s,DCL/s,stabcmd ,Tcmd,DLCcmd,deli-3 (9) 
Glee: 3) 13:18) ,:): 

Diic=zeros(9,18); D11id=zeros(9,6); 

Di2-Dvie11:3,13:18] ,16:18): 


% Pack mixed output feedback plant 
pnom_c=pck(AA, [Bia B2],[CO;C1;C2], [D01c DO2;D11c,D12;D21,D22)); 


4 Pack statefeedback plant 
pnom_d=pck(AA, [Bib B2] ,(C0;C1] , (D01d DO2;D11d,D12]); 


% To scale mixed outputs: z0O- rows 15:25; z1- rows 26:34 
% To scale inputs: noise cols 18:29 


% Scale Nominal Mixed Plants: 
Scale1=diag([0.001,0.001,0.001,0.001,0.000001,0.001,2*ones(1,3)]); 
pnom_c(26:34,: )=Scale1*pnom_c(26:34,:); 


pnom_d(26:34,: )=Scale1*pnom_d(26:34,:); 
4 Scale w 
pnomic(:,15:47)=0. Of *pncmecQ.3 15-17); 
pnom_d(: ,15:17)=0.01*pnom_d(: ,15:17); 
sdof=14*15/2+3*14; 

Dimd=(14 3 6 9 sdof]; 

Dimc=[(14 3 18 9 10 sdof]; 
Sf=zeros(row(CO)); 


% end planti0c 


4. Closed-Loop Analysis Models 
Figure B.4 depicts the simulink model used both for the nonlinear simula- 
tion and the robustness analysis. A D implementation of the various controllers was 
used and can be observed in Figures B.5 and B.6, where the measurement channels 
are differentiated prior to the controller, and then the output of the controller passes 


through double integrators. 


B. HH, DESIGN SCRIPTS 


The following scripts perfornied the 7H, design process including the appropri- 
ate scaling of the weighting functions, calling the design code itself, and then analyzing 
the resulting system. The two subroutines sfbanal5 and snsrloop performed the 
analysis of the state-feedback system and the analysis of the sensor responses. 
loopshaped 
7% Control Design and analysis for plant10c 
% Planti0c is extracted from fi4nlaero5. Includes double integrators 
% on altitude, alpha, and DLC to track altitude and washout alpha and DLC in 
% response to a ramp altitude input. 


% Broken_loop analysis for output feedback 


4 Determines pure hinf dynamic controller 
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Figure B.4: Closed-Loop Simulink Model 
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Figure B.5: Controller Block 
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Figure B.6: Output Integrator Block 
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% Plots brkloop control response vs. sfb design 
% Plots clsdloop command response 

%4 Plots clsd loop sensor response 

planti10c 


4 sfb problem weights-- (22 .15110555100 0] 
sfbanal5, Ksfb=K; 


% opfb problem weights 
4(p20,pijJ=scale16(pnom_a,pnom_b, [25 .65150555 .1000}); 
(p20, p1J=scalei&(pnom_a, pnom_b, {10 30 5 5 .01 101051000 0)); 


distscale=(1,1,1,.00001*[.1 440 .01 .01 .01 .11010105 5 §]]; 
p2=p20; p2(:,15:32)=p20(: ,15:32)*diag(distscale) ; 


4 calculate hinf opfb controller 
K = hinfsyn(p2,10,3,0,50000,500) ; 


WkesBe,Cc,Dc]=unpck(K): 
AAc1l=[AA B2*Cc;Bc*C2 Ac+Bc*D22*Cc]; 


snsrloop4 


Bstar=(B2;zeros(size(B2))]; 
Cstar=(zeros(size(Cc)),Ccl]; 
W=logspace(-3,3,100); 


h 
% broken loop controller response 


1 


Ka=Cc; Ka(1,:)=zeros(1,14); 
Tuui=pck( (AA, B2*Ka;Bc*C2,Ac+Bc*D22*Cc] ,Bstar(:,1),Cstar(1,:),0); 
BrkLoopi=frsp(Tuu1i,W); 


Kb=Cc; Kb(2,:)=zeros(1,14); 
Tuu2=pck( CAA, B2*Kb; Bc*C2, Ac+Bc*D22*Cc] ,Bstar(:,2),Cstar(2,:),0); 
BrkLoop2=frsp(Tuu2,W); 


Ke=Cc; Ke(3,:)=zeros(1,14); 
Tuu3=pck((AA,B2*Kc;Bc*C2,Ac] ,Bstar(: ,3),Cstar(3,:),0); 
BrkLoop3=frsp(Tuu3,W); 


figure(7), 
welorc: 1i¥,lm’,BrxLoopi,’r-’ ,BrkLoop2, 'g--’ ,BrkLoop3, ’*b-.’,sfbloops,’y’), grid 
title(’Broken Loop Controller’), 


fognme 8), vplot(’nyq’ ,BEkLoop1, ’r-’ ,BrkLoop2,’g--’ ,BrkLoop3, ’b-.’ ,sfbloops,’y’), 


eric. title( Nyquist Plot’), 
axis([-5 5 -5 5]),axis(’square’),axis(’equal’), 


Lao 


yA 
7% Open Loop controller response 


yA 


Ke=zeros(3,12); 

Tuu4=pck( (AA, zeros(14,14) ;Bc*C2,Ac] ,Bstar,Cstar,zeros(3,3)); 
Openloop=vsvd(frsp(Tuu4,W)); 
figure(9),vplot(’liv,1lm’ ,Openloop) ,grid, 

title(’Open-loop Controller Response’ ) 


74, Closed loop command response 
Bin=(BB(: ,1:3) ;zeros(14,3)]; 
Cout=(CC((5:6,12],:), (zeros(2,14) ;DD(12,16:18)*Cc]]; 
Cout2=(CC((5:8,13:15]/,:) DDC (S:8,13:15]) , 16: 18) *Cc]- 


Thh=pck(AAcl ,Bin(: ,1),Cout(1,:),0); 
Tvv=pekCAAc], Bin’; ,2)),couci2,. 20): 
Ttt=pek( fel. Bin. 3), cout. 0 


Cloop1=frsp(Thh,W); 
Cloop2=frsp(Tvv,W); 
Cloop3=frsp(Ttt,W); 


figure(10), 
vplot(’liv,1lm’ ,Cloop1,’r’ ,Cloop2, ’g’ ,Cloop3,’b’ ,sfbcmdloop, "c” ,dB3thres, mee 
title(’Closed Loop Command Responses’), 


% Closed-loop eigenvalues 

(V,E]=eig(AAcl); E=diag(E); 

disp(’Closed Loop eigenvalues and damping ratios’) 
([E,-cos(angle(E) )] 


% Open Loop eigenvalues and controller zeros 
disp(’Open-Loop Poles’) 
E1=eig(AA) 


disp(’Controller Zeros’ ) 
Kzero=tz(Ac,Bc,Cc,Dc) 


h 
% mu analysis of the closed-loop systems 


vA 


disp(’do you want to do the mu analysis?’) 

disp(’Type qq=0, followed by return to stop, else type return’) 
qq=1; 

keyboard 

1f qq==0, return, end 

W=logspace(-2,3); 


4, sfb mu 

Asfb=(AA+B2*Ksfb) ; 

Tdel=pck(Asfb,BB(: ,19:21),CC(16:18,:),DD(16:18,19:21)); Tdelrsp=frsp(Tdel,W); 
MuTsfb=mu(Tdelrsp,[{1 1;1 1;1 1)); 


4 opfb mu 

U0=134*1.6889; 

Delta=0.2*eye(3); 

[Ad,Bd,Cd,Dd}=linmod(’f14nlclsd5’); 

Tdel2=pck(Ad,Bd(: ,16:18) ,Cd(16:18,:) ,Dd(16:18,16:18)); 
Tdel2rsp=frsp(Tdel2,W); 

MuTopfb=mu(Tdel2rsp, [1 1;1 1;1 1]); 

mrewre d)),vplot(’liv,im’ ,MuTsfb,’-’ ,MuTopfb, ’--’), 

4 title(’Structured Singular Values’), 

grid 


Siibamalo 


7, Scale output vector 21 
4, (p2,piJ=scalei5(pnom_a,pnom_b,([2 2 .151105551000}); 
([p2,p1]=scalei5(pnom_a,pnom_b, [10 30 5 5 .01 1010510000)); 


7, zero out uncertainty columns 
pi(:,17:19)=zeros(size(pi(:,17:19))); 


4, Analysis of state feedback control system 
K = hinffi(p1,3,0,50000, 1000) ; 


nn =80; 
W=logspace(-3,3,nn); 
K=K(: ,1:14); 


4 broken loop controller response 


Ka=K; Ka(i,:)=zeros(1,14); 
Tuul=pck (AA+B2*Ka,B2(:,1),K(1,:),0); 
BrkLoopi=frsp(Tuul1,W) ; 


Kb=K; Kb(2,:)=zeros(1,14); 
Tuu2=pck (AA+B2*Kb,B2(:,2),K(2,:),0); 
BrkLoop2=frsp(Tuu2,W) ; 


Ke=K; Ke(3,:)=zeros(1,14); 
Tuu3=pck (AA+B2*Kc,B2(:,3),K(3,:),0); 
BrkLoop3=frsp(Tuu3,W) ; 


sfbloops=(BrkLoopi(i:nn,1),BrkLoop2(1:nn,1),BrkLoop3(1:nn,1)J; 
sfbloops=vpck(sfbloops, getiv(BrkLoop!) ); 


figure(1),vplot(’liv,1m’ ,BrkLoop1, 'x—’, Brklocp2. g—— Bakioope ) boa 
title(’Broken Loop Controller Response’),grid 

figure(3) ,vplot(’nyq*)BukLoop! , 'r-* ,BrkLoop2, °g-—’ |BukLoops, Earaae 
axis([-5 5-5 Sijegiid 


7% closed loop command response 


Thh=pck(AA+B2*K,B1ib(:,1),CC(5,:)+DD(5, 16: 18)*K,DD(5,1)); 
ClsdLoop4=frsp(Thh,W); 


Tvv=pck (AA+B2*K ,B1b(: ,2),CC(6,:)+DD(6,16:18)*K,DD(6,2)); 
ClsdLoop5=frsp(Tvv,W); 


Ttt=pck (AA+B2*K ,B1b(:,3),CC(12,:)+DD(12,16:18)*K ,DD(12,3)); 
ClsdLoop6=frsp(Ttt ,W); 


sfbcmdloop=[ClsdLoop4(1i:nn,1),ClsdLoopS(1:nn,1),ClsdLoop6(1:nn,1)]; 
sfbcmdloop=vpck(sfbcmdloop, getiv(ClsdLoop6) ); 


dB3thres=cos(pi/4)*ones(size(W) ); 
figure(2),vplot(’liv,lm’ ,ClsdLoop4, ’r-’ ,ClsdLoopS, 'g--’ ,ClsdLoop6, ’b-. ” |dB3thwecu ae 
title(’Closed Loop Command Response’), grid 

[V,E]=eig(AA+B2*K); E=diag(E); V=abs(V) ; 

[E,-cos(angle(E) )] 


return 


snsrloop4 


% Analysis of the sensor responses 
% Intended for call by loopshape script 


Biq=[zeros(size(Bc));Bc]; 
CCq=(zeros(size(CC)) ,CcCc]; 


WW=logspace(-5,5,100) ; 
% closed loop sensor response 


Snsri-pek( Ac, Bce(:, 1), C20 inno) 
SnsrLoopi=frsp(snsri1, WwW) ; 


snsr2=pek( Ac, Bel: ,2)),c2(2,.-) 0). 
SnsrLoop2=frsp(snsr2, WW) ; 


Sisrd=pek (hey bel, 3) C70). 


SnsrLoop3=frsp(snsr3, WwW) ; 


snsr4=pck(Ac,Bc(: ,4),C2(4,:),0); 
SnsrLoop4=frsp(snsr4, WwW) ; 


ememe-pek (Ac,Bc(:,6),C2(5,:),0); 
SnsrLoop5=frsp(snsr6&, Ww) ; 


snsr6=pck(Ac,Bc(:,6),C2(6,:),0); 
SnsrLoop6=frsp(snsr6, WwW) ; 


snsmn-pek(aAc,Bc(:,7),C2(7,:),0); 
SnsrLoop7=frsp(snsr7, WW) ; 


Sisme=pek(Ac,Bc(:,8),C2(8,:) ,0); 
SnsrLoop8=frsp(snsr8, Ww) ; 


ensio-pek (Ac,Be(: ,9),C2(09,:),0); 
SnsrLoop9=frsp(snsr9,Ww) ; 


enemlO=pek(Ac,Bc(:,10),C2(10,-:),0); 
SnsrLoop10=frsp(snsri10,WW) ; 


figure(4),clg 

Veloce liv, im’,SnsrLoop?,’-’,SnsrLoops,’--” ,SnsrLoop9, ’-.°, SnsrLoop10,'-’) ,hold on 
Velot lav,lm’,SnsrLoop4, ’r-’,SnsrLoopS, ’g--’ ,SnsrLoop6, ’*b-.”) 

Velen liv,im’,SnsrLoopl,’r-’ ,SnsrLoop2,’g--' ,SnsrLoop3,’b-.”) 


return 


C. MIXED #2 / H.. CONTROLLER DESIGN SCRIPTS 
The script in this section was used to design the mixed controller described in 
Chapter IV. 


msfbanal 


% Design and Analysis of mixed state-feedback control system 
planti10c 
p=pnom_d; 


“scale z0 
moceale=11,10000,1,1000,1,.1,0,0,0,0,0]; 


p(15:25,: )=diag(zOscale)*p(15:25,:); 


Were. k,b,ct,P1,P2,o0c,t]= h2infsyn(1,p,Damd,Sf,25000,0.01); 
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Ksfb=K; 


nn =80; 
W=logspace(-3,3,nn) ; 


7% broken loop controller response 


Ka=K; Ka(1i,:)=zeros(1,14); 
Tuui=pck(AA+B2*Ka,B2(:,1),K(1,:),0); 
BrkLoop1i=frsp(Tuu1,W) ; 


Kb=K; Kb(2,:)=zeros(1,14); 
Tuu2=pck(AA+B2*Kb,B2(:,2),K(2,:),0); 
BrkLoop2=frsp(Tuu2,W) ; 


Kce=K; Ke(3,:)=zeros(1,14); 
Tuu3=pek (AA+B2*Kc ,B2(:,3),K(3,:),0); 
BrkLoop3=frsp(Tuu3,W) ; 


sfbloops=(BrkLoopi(1:nn,1),BrkLoop2(1:nn,1),BrkLoop3(1:nn,1)]; 
sfbloops=vpck(sfbloops, getiv(BrkLoop1) ); 


figure(1),vplot(’liv,1im’,BrkLoop1, “r—" ,ErkLoop2, ‘g-—" ,Brkbocps. base) 
title(’Broken Loop Controller Response’) ,grid 

figure(3), vplot( ’nyq’ ,BrKLoop1- "2-7 BrkLoop2, g-— sErkEcops | boeor 
pees (iss S S65 EN) faer cel 


% closed loop command response 


Thh=pck (AA+B2*K ,B1b(: ,1) ,CC(5,: )+DD(5, 16:18) *K,0); 
ClsdLoop4=frsp(Thh,W) ; 


Tvv=pck (AA+B2*K ,B1b(: ,2) ,CC(6,: )+DD(6,16:18)*K,0); 
ClsdLoop5=frsp(Tvv,W) ; 


Ttt=pck (AA+B2*K ,B1b(: ,3) ,CC(12, :)+DD(12, 16: 18)*K,0); 
ClsdLoop6=frsp(Ttt,W) ; 


sfbcmdloop=(ClsdLoop4(1:nn,1),ClsdLoop5(1:nn,1),ClsdLoop6(1:nn,1)]; 
sfbcmdloop=vpck(sfbcmdloop,getiv(ClsdLoop6) ) ; 


aB3thres=cos(pi/4) *ones(size(W)); 


figure(2),vplot(’liv,1m’ ,ClsdLoop4,’r-’ ,ClsdLoop5, ’g--’ ,ClsdLoop6, ’b-.’ ,dB3thtecusavaas 
title(’Closed Loop Command Response’) ,grid 


[V,EJ=eig(AA+B2*K); E=diag(E); V=abs(V); 
[E,-cos(angle(E))] 


return 
% end msfbanal.m 





APPENDIX C:INTERIOR POINT CODES 


A. GENERAL REMARKS 

This appendix documents the interior point codes used during for many of the 
example problems cited in the body of the report. The codes and their structure are 
briefly described followed by a verbatim listing of the routines. The codes are followed 
by comments on practical issues of their use. The original codes upon which these 
are based were provided by Professor Khargonekar of the University of Michigan and 
were the result of work performed by Enrique Bayens. his student. The algorithm 
follows [Ref. 14] as outlined in Chapter I], and is written as MATLAB function files. 

These codes are problem independent, and are structured to solve the Eigenvalue 
Problem (EVP), or the more general Generalized Eigenvalue Problem (GEVP). Recall 


that the GEVP has the form: 


Minimize: A, 


AB(a) — A(x) 0 0 
Subject to: 0 Bir) 0 0 
0 0 Gn 
where A(r) = Ao+)_j-, T;A;, B(f) = Boyt), 2,8; and C(£) = Co+y 2 ae 


EVP is the simplified case where B(.r) = 1. We will refer to the set {Ao, A1,...,An} 
as the basis for the affine matrix functional A(z). The application of these codes to 
any particular problem simply requires that the problem be posed as a GEVP and 
the three sets of bases determined and stored. 
1. Posing a Basis 
Two important structural concepts introduced in Bayens’ original code 


provide a mechanism for passing these bases to the interior point routines. The firsi 
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is What he calls an “a-matrix”, which is simply an accounting method for storing a 
basis as a single argument, which can easily be passed from function to function in 
MATLAB’s workspace. For exainpleif A(.e) = “Ag+ S 33, 75 Ai. then the corresponding 
a-matrix is Aa= [Ag, Aj,..., An]. For many control problems, these matrices can be 
huge, and the interior point methods can consequently be RAM intensive. In many 
applications, the matrices A(z) and/or C’(.°) may have structure. That is, A(a) or 
C'(a) may themselves be comprised of diagonal blocks of matrices. In this case, it is 
advantageous to use the structure to reduce the computational expense. The codes 
each then ask for a structure matrix Se, which defines the internal structure of a set 
of basis matrices Ca. The number of rows of S is then the number of blocks in C'(r). 
Each row has two scalar values. The first value is a “1” or “0”, and signifies whether 
the associated block is a full block, or is itself a diagonal matrix. The second value in 
that row defines the size of the block, t.e., the number of rows and columns. These 
bases are then passed to the interior point routines, along with an miitial feasible 
point and any knowledge of the internal structure of A(x) or C'(.r). Note that for 
all the problems actually solved in this report, the IVP was considered and so the 
a-matrix for B(r) was Ba= {/, zeros], with sufficient zeros such that the size of Ba 
was identical to the size of the a-matrix Aa. 
2. Modifications to the Original Code 

The codes presented here are structurally identical to the originals, but 
differ substantially in execution. The architecture of the inputs, outputs and sub- 
routines are unchanged. Most of the changes were in the interest of either numerical 
efficiency or accuracy. Several changes, for example, took advantage of the structure 


of many LMI’s to reduce the number of multiplications by blocks of zeros. 


The most important changes dealt with the way in which matrix divisions 
were handled. The interior point codes involve frequent divisions by positive definite 
matrices. The original codes extensively used MATLAB’s inv” function. Replace- 
ment with MATLAB’s matrix division notation was occasionally satisfactory and 
efficient, as MATLAB 4.0 first attempts division by Cholesky factorization for any 
symmetric matrix. Many of the divisions, however, involve positive definite matrices 
which are very badly conditioned, to which MATLAB responds with a warning mes- 
sage. This is to be expected since one ts trying to force an LMI to the boundary only 
« away from singularity. At the suggestion of Professor Laurent E] Ghaour (ENSTA, 
Paris), all poorly conditioned divisions were executed by first performing an eigen 
decomposition of the positive definite denominator. The result is a real diagonal ma- 
trix of eigenvalues and an orthonormal matrix of eigenvectors (H7!'L = UA7!U7L, 
where H = UAU’). Multiplying by orthonormal matrices and then division of each 
row by the corresponding scalar eigenvalue optimized the accuracy of the process. 


Consequently the expression: 
HL=inv(H) *L; 
was replaced with: 


[UH ,DH]=eig(H) ; 
Li=UH’*L; 
for i=1:order(H), 
PH Giger 10) Uesigasip iy aio yan) 0 
end 


HL=UH*L2; 


ISS 


This 1s not at all the most efficient means of performing the division, but their badly 
conditioned nature has led more notable researchers to choose the accuracy implicit 
in this approach. It is however much faster than allowing MATLAB’s matrix division 
function to wrestle with very poorly conditioned divisions. 

3. The Principal Code 

The function centers3, and its variations is the top level program that 
solves the EVP. The “3” simply identifies the code as being the third variation to 
Bayens’ original. Three variations to centers3 were used. The first centers3b simply 
suppressed workspace printing. Tle next centers3c suppressed workspace printing 
aud included the structure of A as an input argument (the original had only used the 
structure of C’). Finally, centers3d restored workspace printing, while continuing to 
permit the structure of both A and C to be passed. 

As discussed above, centers3 is not problem specific, but suitable for 
solving any EVP. As input arguments it requires the bases (a-matrices) associated 
with the three EVP matrix functionals, (A(v), B,C(.))); a matrix which defines any 
internal structure of the problem; and feasible initial conditions zx and A from which 
to start the search. (Finding a good initial point is discussed later in this appendix). 
The remaining inputs are numerical thresholds and adjustments. Since centers3 
is not problem specific, it was used for all I-VP’s, including the mixed discrete and 
continuous problems, and the plant optimization problems. In each of those cases, 
scripts were written which prepare the a-matrices appropriate to each problem, aud 
determine a suitable initial conditions before calling centers3. 

As written by Bayens, the original centers was intended to solve the more 


general GEVP, but a bug in the subroutine assump2 led me to close the path such 


that only constant B matrices were permitted. Since a GEVP solver was not required 

during this work, the bug was not isolated or corrected. Little work should be required 
m1 order to permit the code to solve the GEVP, if it becomes required. 

4. The Subroutines 

A large number of function files accompany and are called by the central 

function, centers3. Several of these functions could be regarded as administrative, 

and are used to manipulate a-matrices. They are useful both within centers3, 

and also in preparing a-matrices in problem specific applications prior to calling 

centers3. The functions affin and getvec use the a-matrix (basis) of A to map 

back and forth between x and A(a‘): A(x) = affin(Aa,.r) and r = getvec( Aa, A(z)). 


The function adiag manipulated a-matrices of D(x) and E(2) to find the a-matrix 
Der) 0 


of the funetional f(z) = | 0 E(x) 


| This was used extensively whenever two 
LMI’s were jointly imposed. 

The following set of functions could rightly be called subroutines, as their 
lise is restricted to calls from within centers3. The functions assumpib, assump2, 
and assump3c checked the necessary assumptions before starting the method of 
centers. First, assump1b verified that the initial point is feasible. Next, assump2 
confirmed that B(x) was bounded away from singular for the GEVP. It currently 
uot called by centers3, and would have to be fixed in order to solve the GEVP. It 
is included here for completeness. The subroutine assump3c actually performed 
the first iteration of the search for a analvtical center in order to determine if the 
problem is bounded. If this first iteration converged, then the problem was considered 


bounded. The majority of the work was performed by the subroutine nesnem3a, 


which actually performed the search for the analytic center within the inner-loop of 
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the method of centers. Within its loop, it in turn called grad2b, which returned the 


gradient and hessian at each step of the search. 


B. PRACTICAL ISSUES 


This section addresses a number of practical issues regarding the use of these 
codes. The first of these comments is relevant to the use of any interior point codes 
for the solution of LMI’s. Subsequent remarks pertain specifically to the author’s 
experience in the use of this particular implementation. 

1. Determining a Feasible Initial Point 

All the interior point methods are dependent upon initializing the optimiza- 
tion with 7 and A in the feasible set, i.e. Af) — A(a!) > O and C(r)). In fact, 
the codes in section C verified this requirement prior to any optimization attempt. 
As a matter of practical experience, it 1s not just enough to initialize the algorithm 
at any feasible point, but ideally a point well away from the boundary for which the 
problem becomes singular (unfeasible). Riccati inethods are a very poor choice for 
determining a feasible initialization point. This is because the numerical methods 
for solving the Riccati equation must generally make allowance for a tiny negative 
eigenvalue in an otherwise positive definite solution. Even a very tiny negative eigen- 
value however places the corresponding vector x outside boundary function of the 
LMI with no means of crossing the boundary. One method, suggested by El Ghaou1, 
is to perform a preparatory optimization by setting C(r) = 1 > 0, 7 = [0,..., 0], 
and minimizing \ such that AJ + C'(r) > 0. For the original problem to be feasible, 
a \ < 0 must exist. Furthermore, by minimizing \<0 (finding its maximum nega- 
tive absolute value), the “best” feasible value of x!) is determined. The problem of 


interest can then be initialized with 2) and some Af) >> Amar(A(r). 


19] 


A modification to this approach was routinely used. Specifically C(ar) usu- 


| R(x) 


ally had some structure such as C'(r) = , and the first n elements of 


ve) 
x were the diagonal elements of Y. In this case the preparatory problem was posed as 
minimize \ such that AJ + R(x) > 0, subject to Y(x) > 0. This problem is easily fea- 
sibly initialized at cr = [1,1,...,1,0,...,0)7, such that Y(2@°) = 7 > 03am 
\) S> Xmar( R(x). Consequently, the solution of an LMI frequently required two 
passes through the interior point algorithm; the first to determine a feasible solution, 
and the second to determine the (sub)optimal solution. 
2. Practical Observations 


The following observations were made relative to this specific implementa- 


tion of the interior point method. 


1. Much of the clamor surrounding interior point methods is due to their reputed 
dramatic increase in computational speed over other convex methods. This 
makes intuitive sense in that the method does not spend any time outside of 
the feasible set, while we found it common for 90% of the iterations of the El- 
lipsoidal methods to be spent isolating the feasible set. In practice, we found 
little difference in speed between the two methods on small problems. I am 
certain this is because of the choice of MATLAB as the programming language. 
MATLAB was chosen because that was language of the original codes provided 
by Khargonekar, and because it could be rapidly implemented for the desired 
problems. Computational speed was not as critical as speed of implementa- 
tion. With the attention the interior pomt methods have received in the past 
two years, translating these codes to a faster format would be unadvisable, as 


commercial codes are sure to become available shortly. 
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2. Mathematically, the interior point codes are guaranteed to stay within the fea- 
sible set due to the influence of the boundary function [Ref. 15]. This was not 
our practical experience. Two factors routinely led to the method of centers 
wandering out of the feasible set. First of all. the numerical adjustment 6 de- 
termines how close to singular the search for an analytical center 1s initialized. 
Mathematically, the code should converge for all @ € {0,1]. In our experience, 
values much less than 0.1 resulted in the path of centers occasionally jumping 
outside the feasible set. Secondly, in a similar vein, the method should work 
if initialized at any MO > Ajar(A(r)). Again. if the problem was initialized 
too close to the boundary for which the LMI was singular, then path of centers 
could wander infeasible before converging to a optimum value. Consequently, 
\) was usually chosen well clear of the boundary, on the order of 0.1 or 1 greater 
\mar(A(ar!®)). Furthermore, there were some problem geometries for which the 
codes were inexplicably unstable. Traps were implemented tn the code tn order 
to rapidly identify divergence from the feasible set, thereby slowing the general 
execution of the routines. This was done in order to alert the researcher to 
bad output, but did not correct the problem. The source of these difficulties 
Is unquestionably the inherently ill-conditioned nature of these problems, their 
very intent being to puch the problem to singularity. Again, the advent of more 


robust commercial codes would hopefully mitigate these sensitivities. 


C. MATLAB FUNCTION FILES 


This section includes a listing of the interior point optimization code centers3 
and its associated subroutines. 


centers3 
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function [xopt,lambdaopt,stat,err]=centers3(A,B,C,Sc,x, lambda, theta, prec, bound) 
%, Function: 
74, {xopt,lambdaopt,stat,err]=centers3(A,B,C,Sc,x, lambda, theta, prec, bound) 


7% Description: 
4% This function solves the problem of minimize the maximum generalized 
4 eigenvalue of the pair (A(x),B(x)) subject to a constraint C(x)>0. 


% A(x) and B(x) are a (symmetric, symetric-positive-definite) pair of 
4, matrices that depend affinely on a vector-valued variable x. 


4 Inputs: 


i R= UHOW AL AT 
(B= (iBO AB ieee Bhi 


4% C=({CO,C1,...,Cn], are a-matrices, that is arrays of matrices that 

h represent an affin matrix expression depending of a vector x. 

% Sc is a matrix representing the block structure of the restriction 
ie C(x)>0. Sc has 2 columns and the number of rows equals the number 
i of blocks in C(x). The first column contains the type of block 


yf (type 0 diagonal block, type 1 full a the second column is 
ys The size of each block. 

jeux (ele Gen 2S. an eee aT feasible vector. 

%, lambda is an initial value which satisfies lambda*B(x)-A(x)>0. 

4% theta is a parameter with O0<theta<1. Typical values are close to 0. 
4% prec is the precision in computing the optimun. 

% bound is a limit of norm(x) to detect unboundness of the 

y/ problem. 

% The affin matrix functions can be calculated using the function affin 
% A(x)=affin(A,x)=AO+A1*x1+...+An*xn, 

% B(x)=affin(B,x)=BO+B1*x1+...+Bn*xn, 

% C(x)=affin(C,x)=CO+C1*x1+...+Cn*xn, 


7%, Outputs: 


4% xopt is the optimal vector 

4 lambdaopt is the maximum generalized eigenvalue 

4% stat is a matrix with the statistcs of the algorithm. The first column 
if contains the iteration number, the second the number of Newton_NN 

A iterations, and the third a bound of the error in the compute of the 
i optimal value lambdaopt. 


% Necessary assumptions to solve the problem: 


% (1) The initial point is in the feasible set. 

4 (2) B is bounded away from singular on the feasible set, and we know 
% bmin such that B(x) > bmin*lI 

% (3) The feasible set is bounded. 

4 err is an error code. If err=1 the initial point is not feasible, if 

% err=2 assumption (2) does not hold, if err=3 the problem is unbounded, 
% in this case xopt is yet a feasible point, but norm(xopt) >= bound(1 + 
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7venorm(x) ). 
7, Called functions: 


% assump1, checks assumption (1). 

% assump2, checks assumption (2). 

“% assump3c, checks assumption (3), uses eigen division with Hessian 

% bound1, computes a bound of the difference between lambda and the real 

y/ minimal value 

% affin, computes an affin matrix function. 

% adiag, computes the a-matrix of C(x) where C(x)=diag[A(x) ,B(x)]. 

% nesnem3a, Newton algorithm to compute an analytic center. (eigen division) 
4 grad2b returns barrier gradient and hessian (structured version) 


% As of 1530 on 10/12/93 this is the best performing combination so far. 
% Direct division by hessian leads to enormous increase in cputime, 

4 probably because matlab does svd division when it sees an ill- 

% conditioned problem. 


% Checking assumption (1) 
yA 
disp(’Method of centers. Checking initial point ...’); 
err=assumpib(A,B,C,x,lambda) ; 
if sum(err’)<0O 
disp(’Error in centers.m. Infeasible initial point’); 
disp(err) 
return; 
end 
yA 
% Checking assumption (2) 
yi 


disp(’Method of centers. Checking if B(x) is bounded ...’); 
[mb ,nb])=size(B) ; 
if max(max(abs(B(:,mb+1:nb))))==0, %is B(x) constant? 


bmin=min(eig(B(:,1:mb))); 
constantb=1; 
else, 
vf bmin=assump2(A,B,C,x,bound); % I THINK THIS PATH HAS A BUG! 
disp(’non-constant b is currently disabled’ ) 
constantb=0; 
end 
if bmin<=0 
disp(’Error in centers.m. B(x) is not bounded away of zero’); 
err=2; return; 
end 
yA 
% Checking assumption (3) 
hn 
disp(’Method of centers. Checking if restriction is bounded ...’); 
[err ,x2,lambda3,Z,it2]=assump3c(A,B,C,Sc,x, lambda, theta, bound) ; 


195 


if err== 
disp(’Error in centers.m. The restriction is unbounded’); 
XOpt=Xx2; 
lambdaopt=lambda3 ; 
return; 
end 
b 
% Algorithm of the centers 
Z, 
(na,ma]=size(A); (mz ,nzJ=size(Z); S=(1,na:Sc]; 
iti=1; 
cond=mz/bmin/trace(Z(1:na,1:na)); 
Ax=affin(A,x2); Bx=affin(B,x2); 
lambda2=max(eig(Ax,Bx)); 
stat-(1,it2,cond, lambdazi- 


disp(stat); 
cond=1; % resets cond to force second pass through nesnem 
while(cond>prec) 

x1=x2; 


lambdal=lambda3; 
lambda3=(1-theta)*lambda2+theta*lambda!l ; 
if constantb==1, 
F=adiag(-A,C); 
F(1t:na,1:na)=F(1:na,1:na)+lambda3*B(i:na,i1:na); 
{x2,Z,it2,mf]=nesnem3a(F,x1,S); 
Ax=affin(A,x2); 
lambda2=max(eig(Ax)); 
else, 
F=adiag(lambda3*B-A,C) ; 
(x2,Z,it2,mf]=nesnem3a(F,x1,S); 


Ax=affin(A,x2); Bx=affin(B,x2); 
lambda2=max(eig(Ax,Bx) ) ; 

end 

cond=mf/bmin/trace(Z(1:na,1i:na)); 

VEl=ititi. 


stati=(it1,it2,cond,lambda2]; 
if lambda2>lambda3, 
error(’centers3 blowing up’) 
end 
stat=[stat;stat1]; 
disp(stat1); 
end 
XOpt=x2; 
lambdaopt=lambda2; 
tol=cond; 


return; 


7, end centers3 
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assumpI|b 


function err=assumpib(A,B,C,x, lambda) 
vA 

% err=assump1(A,B,C,x,lambda) 

le 


% Description: 


4 This function checks that the initial point for the algorithm of the 
% centers is admissible. 


% Inputs: 


% A a-matrix 

% B a-matrix 

7% C a-matrix 

4 xX vector compatible with the a-matrices. 
7, lambda 


7% Outputs: 


4 err is an error code, err={0 0 0] if the initial point is admissible, err<0O 
i} otherwise. 


¥%, Comments: 
% See function centers 


err=[0 0 0); 
zi=min(eig(lambdataffin(B,x)-affin(A,x))); 
z2=min(eig(affin(B,x))); 
z3=min(eig(affin(C,x))); 
1f z1<=0 

err(1)=z1; 
end 
1f z22<=0 

Orn (2) =22; 
end 
1f 23<=0, 

err(3)=z3; 
end 
return; 


% end assump1b 


assump2 


function bmin=assump2(A,B,C,x, bound) 


4 


Pot 


% bmin=assump2(A,B,C,x, bound) 
4, Description: 


% This function check that the restriction B(x)>0 is bounded away from 
% be singular, it determines a lower bound bmin solving an auxiliary 

% Minimization problem. If B(x)=B constant matrix, bmin is the minimum 
4 eigenvalue of B. 


% Inputs: 


A a-matrix, 
% B a-matrix, 
C a-matrix, 
x vector, 
% bound is a bound to detect that C(x) is unbounded. 


% Outputs: 
%, bmin is a bound for B(x) 
% Comments: 


%, See function centers 


{(na,ma}]=size(A); 
i 
% If B(x) is a function of x 
yh 
if B(: ,nat1:ma)~=zeros(na,ma-na) 
A1=-B; 
A2=aident(size(Al1)); 
lambda=max(eig(affin(A1,x)))+1; 
[xlopt,b,stat,err]=centers(A1,A2,C,Sc,x, lambda, theta, prec, bound) ; 


if err== 

bmin=-b; 
else 

error(’Error checking assumption (2)’); 
end 


ye 

% If B(x)=B constant matrix 

is 

else 
bmin=min(eig(B(:,1:na))); 

end 

return; 


assump3c 


function [err,xnew,lnew,Z,itJ=assump3c(A,B,C,Sc,x, lambda, theta, bound) 

h 

% (err,xnew,lnew,Z,itJ=assump3b(A,B,C,Sc,x, lambda, theta, bound) 

h 

% This function checks assumption (3) of the method of centers using 

% one iteration of the centers method, if the norm of x diverges, then 

% an unbounded direction exists. It returns the analytic center x, the 
% value of the maximum eigenvalue lnew, and an error code which is err=3 
% if the problem is unbounded and err=0 otherwise. 


% Inputs: 


% A,B,C a-matrices. 

% Sc matrix with the block structure of C(x) 

%4 x vector 

% lambda initial value 

% theta parameter of the method of centers. 

% bound is a limit for the norm of x to detect divergence. 


% Outputs: 


% err error code. err=3 if the problem is unbounded, otherwise err=0. 
% xnew analytic center. 

% lnew new value of lambda for xnew 

% Z=inv(F(x)) 

% it is the number of iterations 


%, Comments: 


% See function centers. 
% Modified to call grad2b, uses eigen division 


[na,ma]=size(A); 

Ax=affin(A,x); 

Bx=affin(B,x); 
lambdai=max(real(eig(Ax,Bx))); 
lnew=(i-theta) *lambdai+theta*lambda; 
F=adiag(lnew*B-A,C) ; 

S=iena:sc) ; 


Xx2=x; delta2=1; 1t=0; 
while((delta2>0.001)&(norm(x2) <bound) ) 
x1=x2; 


deltai=delta?2; 
(g,H,Fx,mf]=grad2b(F,x1,S); 
(uH ,dHJ=eig(H) ; 
if any(diag(dH)==0), 
error(’Hessian collapsed trying to analyze assump3’), 
end 
Hg=uH*(diag(dH).\(uH’*g)); 
delta2=sqrt(g’*Hg) ; 
if delta2 > .25 
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alpha=1/(i+delta2) ; 
else 
alpha=1; 
end 
x2=x1-alpha*Hg ; 
it=it+l; 
end 
[uF ,eF)=eig(Fx) ; 
Z=uF*(eF\uF’ ); 
if any(diag(eF)<0) 
error(’Fx is not positive definite in assump3c’) 
end 
xnew=x2; 
Fx2=affin(F,x2); 
if any(eig(Fx2)<=0) 
disp(’Terminal point in assump3c infeasible- reverted to previous’ ) 
xnew=x1; 
end 
if norm(x2)>bound 
err=3; 
else 
err=0; ; 
end 
return; 
% end assump3c 


function F = affin(A,x,col) 

yA 

4 FE =) affin( sx, cod) 

h 

7%, Description: 

hh 

% This function computes the affine matrix expression 

% F = AO + Al x1 + ... + Ar xr. If A is an empty a-matrix, 


%, the function returns F=[]). 


% Inputs: 

vE 

% A is an a-matrix A=[(AO,A1,...,Ar], 
4 © 1S a vector x (sneer 


% col is the number of columns of A, if not provided, it is assumed 
vf equal to the number of rows. 


4 Outputs: 


%, F is the matrix F = AO + Al x1 + ... + Ar xr. 


if A=={(] 
F=[(); 
return: 
else 
(ma,na]=size(A); 
(mx ,nx]=size(x); 
if nargin==2 
col=ma; 
end 
n=na/col; % number of matrices in A 
if n~=max(mx,nx)+i 
error(’Error in affin.m. Incompatible dimensions’ ) 
end 
BACs 1:GoL) ;: 
7Or 1=1;n=1 
j=col*i; 
F=F+A(:,j+1:j+col)*x(i); 
end 
end 
return; 


adiag 


function F=adiag(B,C) 


4% given the a-matrices B and C, finds the a-matrix F such that 
% affin(F,x)=(Caffin(B,x) ,0; 0, affin(C,x)] 
A 


% calls daug from mutools 


(nb,mb]=size(B); [nc ,mc]=size(C); 


dim=mb/nb; 
F=(]; 
for 1=0:dim-i, 
ki=1*nb; k2=1¥*nc; 
F=(F,daug(B(:,ki+i:kit+nb) ,C(:,k2+1:k2+tnc))J; 
end 


% end adiag 


nesnem3a 


function [xopt,Z,iter,mf]=nesnem3a(F,x,S) 
vi 

% (xopt,Z,iter]=nesnem3(F,x,S) 

vA 
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7% Description: 


7, This function determines the analytic center ’xopt’ which minimizes 
4 the barrier function f(x)=log det inv(F(x)) using Nesterov and 
4 Nemirovsky’s Newton algorithm, where F(x)=FO+F1i*x1+...+Fr*xr. 


ie 

i Inputs: 

i, 

i. b= LROr rie. Fn | 

“4x = [x1,...,xn], is a initial value, 


4 Outputs: 

4 xopt analytic center 

74 Z=inv(F(x)) which will be used later in the stopping criteria 

i for the method of the centers, actually is calculated in function 
y/: "grad". 

% iter number of iteration to find the analytic center. 

2 Related functions: 


4, grad2b computes gradient and hessian of f(x)=log det inv(F(x)). 


¥%, Comments: 
7%, Called by centers. 


% This version uses eigen decomposition for ill-conditioned divide. Computes Z out of loop 


Xx1=x; iter=0; delta=1; 
while(delta>.001) 
Cg,H,Fx,mfJ=grad2b(F,x1,S);  % Determination of gradient and hessian 


[ul ,dH]=eig(H); 
if any(diag(dH)==0), 
disp(’Hessian collapsed’), 
break 
end 
Hg=uH*(diag(dH).\(uH’*g)); 
delta=sqrt(g’*Hg); 4 Newton decrement 
if delta > 25 
alpha=1/(1+delta) ; 
else 
alpha=1; 
end 
x1=x1l-alpha*Hg ; 
iter=itert+1; 
end 
xopt=x1; Z=inv (Fx); 
return; 
4% end nesnem3a 


te 
S 
te 


grad2b 


funetion (g, H, Fx, mf] = grad2b(F,x,S) 
h 

Jolg,) Hh; Fx) = grad2(F,x,S) 

i 

4, Description: 


4% This function determines the gradient ’g’ and the hessian ’H’ 
4% of the barrier function f(x) = log det inv(F(x)), 

% gi(x)=-Trace(ZFi), i=1,...,n, 

jena (x =Trace(ZFi)(ZFj), i=1,...,n, 

4 Z=inv(F(x)) 


% Inputs: 


=~ 
TI 


(FO,F1,...,Fn], 

ele eR, 

% S is the block structure of F(x), S=[s1 s2], where s1 is a vector 

4% with the type of block (type=0 is a diagonal block, type=1 is a full 
4, order block), s2 is a vector with the size of each block. If does not 
% exist matrix S, it is supposed that F(x) is a complete full order 

we block. 


=~ 
» 
" 


% Outputs: 


4 g gradient 
% H hessian 
%, Fx= F(x) 


% This version differs from the original by taking advantage 

% of MATLAB4’s smart division, and differs from grad2 by exploiting 

4 structure. 

% Significant flops are saved by taking advantage of the structure 

4 of the argument of the trace in computing the hessian. 

% Block division is desirable since we’re forcing an ill-conditioned 
4% problem, and the smaller the blocks, the more accurate the division 
4% will be. F(x) should be PD, so matlab4 will use cholesky as long as 
% the subblocks of F(x) remain numerically PD. 


%, Comments: 
¥%, See functions nesnem and centers. 


(mf ,nfJ=size(F); 

if nargin==2, 
S-t1 mt): 

end 

{ms ,ns]=size(S); 

dim=nf/mf-1; 

Fx=affin(F,x); 


g=zeros(dim,1); H=zeros(dim,dim); indi=i; 
for j=1i:ms, 
if (S(j,1)==0) | (S(j,2)==1), 
fOr 1=1:2SCj2) 
FxF=Fx(indi,ind1)\F(Cindi,indi+mf :mf:indi+dim*mf) ; 
g=g-FxF’; 
H=H+FxF’ *FxF; 
indi=indi+i; 
end 
else, 
size=S(j,2); ki=indi:indi-itsize; k2=zeros(1,size*dim); 
for 1=1:dim, 
k2(1+(i-1)*size:i*size)=ki+i*mf; 
end 
FxF=Fx(ki,ki)\F(ki,k2); 
for 1=1:dinm, 
1i=FxF(:,size*(i-1)+1:size*(i-1)+size) ; 
g(i)=g(i)-trace(11); 
H(i,i)=H(i,i)+sum(sum(1i.*11’)); 
for k=it1i:din, 
12=FxF(: ,size*(k-1)+1:size*(k-1)+size); 
H(i,k)=H(i,k)+sum(sum(11.*12’)); : 
Hk; 1) =H kK) 
end 
end 
indi=indi+size; 
end 
end 
return; 


“% end grad2 


APPENDIX D:PLANT/CONTROLLER 
OPTIMIZATION CODES 


This appendix documents the MATLAB script and function files which were 
used in solving the example problems discussed in Chapter V. The first section is the 
function files which perform the optimization. These functions are independent of 
the specific example to be solved, but instead solve a general class of problem, such 
as the joint H, pole placement problem. The second section is the scripts which 
were used to prepare the synthesis models for the example problems. The outputs of 
these scripts were used as the input arguments for the optimization functions in the 


first section. 


A. PLANT/CONTROLLER OPTIMIZATION FUNCTIONS 


This section documents the function files which perform the plant controller 
optimization process. These functions all had similar structure, and input and output 
arguments. The input arguments included the synthesis model, initial plant and cost 
vector , and the optimal plant and associated controller were outputs. The synthesis 
models were required to be state-space representations of the plants with A, B; and 


by 


By expressed as “a-matrices” of the associated plant variables. That is if: 


A = Al6)=Aot GA. 
taal 

By = B(¢c) = By +> 6B, 
i=] 

By = B(¢) = Ba, +5°¢ Ba, 
a 
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then the associated a-matrices were Aa= [Ao, Ay,...,A,r], Bla= [P,,. B1,,---, Bi], 
and B2a= [B,, Bo,,..., Bo,|. The matrices Aa, Bla, and B2a are then the bases for 
tle plant matrices A, By, and Bo. 

Per Chapter V, the general method was to first find a feasible controller which 
minimized the controller margin for the initial plant (maximized tts absolute value), 
then freeze the controller while minimizing the cost function J = c’¢. Both the 
controller optimization and the plant optimization were performed using the interior 
point function centers3 documented in Appendix C. 

The first plant optimization code (plantopt2), which employs a single H. 
constraint, provided the baseline structure for all that followed. Consequently, in the 
interest of volume, this code alone is thoroughly documented. 

1. Plant and Controller Optimization for an H.,, Performance Con- 

straint 
The function plantopt2 and its associated subroutines solves the plant/ 
controller optimization problem with a pure HH, performance constraint. From 


Chapter V, the general method revolves about two EVP’s. Algorithmically: 


lL. Evaluate A(€), Bi(C) , and B,(C). 


2. Determine H, feasibility for the initial, and find a particular solution (W,, Y,) 


to the Riccati 7H. analysis equation. 
3. Create a basis Z for the controller variables W. and Y. 
4. Find the vector € which naps Z to (Wj, ¥>). 


5. iter Using A(C), By(C) , and B2(C), and the basis Z, find the basis for F;, the 


H. LMI, equation 5.2. 
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o 


LU: 


lind a feasible initial eigenvalue Ay for the inequality Ag/ — Ry(€) > 0. 

Use the method of centers to find a controller (represented by a new €) which 
satishes the H,, LMI: 

Minimize: A (over &), 


Subject to: 
Ai— Hi(C.€) 0 
U V(g) 


Note that } must be negative for the problem to be feasible. 


> 0. (D.1) 


Verify that \ represents a feasible solution, or that 1s not so small as to satisfy 


the termination criteria. 
Evaluate W(€), Y(&). 


Using W and ¥ and the plant bases inatrices Aa, Bla and B2da, find a basis for 


the alternate 71,. LMI (equation 5.3). 


. Now optimize the plant cost J = c?¢, subject to the H. constraint, and the 


constraint that the plant variables niust have positive value: 
Minimize: J (over C), 


Subject to: 


ee as 0 0 
0) ciag(¢) 0 20: (D.2) 
0) 0 — fa(¢, €) 


. Evaluate the new plant A(¢), B)(C) , and Bo(c). 


. Go to step iter until exit criteria is satisfied. 


The progress of this algorithm is supported by a number of subroutines. 


Feasibility is tested by Riccati solvers from the p-Tools toolbox to determine an 


initial feasible solution. Note that this particular solution is not precisely feasible in 
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the since of the LMI’s, since it represents the solution of a Riccati equality rather 
than inequality. The inequality will be enforced the first pass through the algorithm, 
and the Riccati solution being “close” to a solution of the inequality dramatically 
reduced the computational workload on the first pass. From the plant and a-matrices 
for the controller variables, the basis matrices for the constraint functional on € are 
constructed by the subroutine hinfres6. The interior point algorithm,centers3, 
then finds a controller that minimizes the controller margin. The controller margin 
must be negative for the controller to be considered feasible and for the algorithm to 
proceed, Furthermore, if the absolute value of the controller margin is less than some 
small numerical threshold (typically 107° to 107'°), then the feasible set is too small 
practically to proceed, and the loop is exited. This 1s the usual exit path. If these 
criterion are satisfied, the code proceeds to the plant optimization phase. Using the 
above controller, the function hinfres4 builds the basis matrices for the constraint 
functional on ¢. The interior point code is then called again to optimize the plant 
cost (over ¢). The loop can also be exited at this point if the cost does not decrease 
from iteration to iteration, or if the maximum iteration count has been reached. If 
the cost has been successfully decreased, then the algorithm returns to the controller 
design phase to find a new controller. The optimal plant, controller, and algorithm 
history are returned as outputs. The other called subroutines are administrative, and 


are described in Appendix C. 


plantopt2 


function [zeta,x1,K>Z,Re, Te )J2errl=.- 
plantopt2(Aa,Bla,B2a,C,D,zeta,weight,thres,gam,theta, prec) 

he 

% (zeta,xi,K,Z,Rc,Tc,J2,err]=plantopt2(Aa,Bla,B2a,C,D,zeta,weight,thres,gam,theta, prec) 

% (zeta,xi,K,Z,Rc,Tc,J2, err]=plantopt2(Aa,Bla,B2a,C,D,zeta,weight,thres) 
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Description: 


Given: 

xdot = A x + B1w + B2u, 
Z = ¢€x + Dorn, 
vf > xX, 


This function determines the minimum state-feedback plant satisfying 
||T.zwll_infty < gamma 


min J=welght*zeta 
subject to: 


R(Z)=AY+YA’+B2W +W’B2’+B1B1’+(CY +DW)’ (CY +DW)< 0, 


Code alternatively finds central controller, and minimizing plant 
using the method of centers to solve equivalent LMI’s. 


Inputs: 


C,D are constant matrices from the state-space realization of the system. 

Aa, Bla and B2a are a-matrices which hold the affine elements 

zeta is the vector that defines the initial plant (A=affin(AA,zeta)) 

weight is the row vector of weights in the objective function 

thres 1s the threshold on the central controller margin 

for determining when to quit the iterative procedure 

gam is a bound of the H-inf norm for the closed loop system. 

theta parameter of the method of centers 

prec is used by the method of centers to determine when to quit the newton 
search for the analytic center. The default is 0.001, bur if the ricatti 
soln indicates that the problem is feasible and yet the method of centers 
cannot find a solution, then this parameter should be adjusted to something 
smaller to allow the newton search to go deeper. 
If the ricatti solvers indicate that the problem is feasible and yet the 
method of centers cannot find a feasible controller, then this parameter 
should be set smaller. 


Outputs: 


Z is the optimized vector of plant parameters 

X1 1s the vector of controller parameters 

K the state-feedback gain matrix 

Z is the basis for the controller matrices W,Y 

Rc, Tc are the bases for the controller and plant optimization constraints 
J2 1s the history of the problem 

err is an error flag 


Called functions: 
basis, computes a basis for a set of block structured matrices 
hinfres, computes the a-matrix of a Riccat1 inequality restriction 
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4 adiag, computes the a-matrix of diag(A(x),B(x)) 

74, atrace, computes the a-matrix of trace(R,X) 

4 aident, gives an a-matrix with the indept. term equals unity and 
Y/ the rest of matrices zeros. 

4 getvec, gives the realization of a matrix in a matrix basis. 

7% affin, computes an affin matrix function. 


%, Comments: 


% The assumptions for this function are standard in the state-feedback 

%, Hinf case, (A,B1) stabilizable and D1 has full column rank. 

4 These assumptions are not checked, though they probably should be. 

4 If the inputs gam, prec and theta are not provided, they are initialized 
% to 1, 0.1 and 0.001 respectively. 


if nargin<1i 


gam=1 ; theta=0.1; prec=.001; 
if nargin==7, 
thres=1e-6 

end 
end 
[ma ,na]=size(Aa); dimz=na/ma; 
[mb1,nb1])=size(Bla) ; nqi=nbi/dimz; 
([mb2 ,nb2]=size(B2a); nq2=nb2/dimz; 


[mc ,nc]=size(C); 


7% Determine initial plant 
A=affin(Aa,zeta); Bi=affin(Bila,zeta,nq1); B2=affin(B2a,zeta,nq2); 


% Determine hinf feasibility/central controller 

% by solving hinf synthesis hamiltonian 

a=A-B2*((D’*D)\D’)*C; 

ham=[a, ((B1*B1’/gam~2)-B2*((D’*D)\B2’)); -C’*(Ceye(mc)-D*((D’*D)\D’))*C, -a’J; 


[x1,x2-farlJi=r1e-sehr (ham) - Xinf=x2/x1; 
if (fail>O) | any(eig(Xinf)<0), 
disp(’Initial System appears infeasible-1’); return 
else 
disp(’Initial Hinf problem feasible’) 
end 


Kp=-(D’*D)\(D’*C+B2’*Xinf); % “central" controller 


% Determine particular soln from central controller 
% by solving hinf analysis hamiltonian 


al=A+B2*Kp; bi=[(B1,10000*sqrt(eps)*eye(ma)] ; c1=C+D*Kp; 
([xi,x2,failJ=ric_schr([al1’,c1’*c1:-bi*b1’ ,-a1]); Yp=x2/x1; 
if (fail>O) | any(eig(Yp)<0o), 

disp(’Initial System appears infeasible-2’); return 
end 
Wp=Kp*Yp; 


yA 

% Initializing the optimization 
yp 

(Z,YY,dimz]=basis2(ma,nq2) ; 
xi=getvec2((Yp;Wp] ,Z); 
Syy=[1,ma] ; 

Rb=eye(matmc, (dimz+1)*(ma+mc )) ; 
Rc=[zeros(ma,ma),YY]; 

Ta=[0, weight]; 
To=eye(1,length(Ta) ); 
J=weight*zeta; 

lam=-1; 

J2=[1; iteration=0; 

cD=[C D]; 


while lam<-1e-12, 
i1teration=iterationtl 


4 


% For fixed plant- find the optimal 


h 


disp(’searching for new controller’) 


builds the basis Z for W,Y 

get initial x1 from initial controller 
establishes the structure of Y 

est. basis for controler EVP 


est. basis for plant EVP 


simplifies argument 


controller (best controller margin) 


%, create the basis for the hinf constraint 
[Ra,Sc2]=hinfres6([A B2] ,CD,B1*B1’,gam,Z) ; 


% determine initial lambda for EVP and add some slop to make it feasible 
% this takes care of changing the equality above to inequality 
lamin=max(eig(affin(Ra,xi))) + 0.1; 


% find the set of controller parameters ’xi’ which minimize the 


% controller margin ’lam’ 


[xiop,lam,stat,err2]=centers3(Ra,Rb,Rc,Syy,xi,lamin,theta,prec,ie12); 


i.err2 =O, 
err=3; return; 


4 terminate if centers couldn’t find a feasible controller (lam>=0), 
“4% or the margin was too small to bother proceeding (lam>-thres) 


elseif lam>=0, 


%4 feasibility criteria 


disp(’centers could not find a new feasible controller’) 


break 
elseif lam>-thres, 


%, termination criteria 


disp(’feasible set too small to proceed’) 


break 
end 


% build new controller W,Y from xi 
YW=affin( [zeros (matnq2,ma) ,Z],xiop,ma); 


V=yYW(i:ma,:); W=YW(mat+1:mat+nq2,:); 


X1=x1op; 


2 


K=W/7 YX - 


h 

4 Fix controller- solve the min airframe problem 

h 

disp(’Optimizing plant for previous controller’) 

4% using the controller above, find the basis for hinf restriction 
(Tc ,Sc]=hinfres4(Aa,B1a,B2a,YW,CD,gam) ; 


% add some padding to previous optimum cost to make problem very feasible 
J=J+.1; 


4 optimize the plant 
(zetaop,jJ,stat,err2]=centers3(Ta,Tb,Tc,Sc,zeta,J,theta,prec,iei2) ; 
if err2°=0 

err=3; 

return; 
end 
zeta=Zetaop; 


% Build the new plant 
A=affin(Aa,zeta); Bi=affin(Bia,zeta,nq1); B2=affin(B2a,zeta,nq2); 
disp( [lam,J]) 


4% Stack the data for output history 
J2=[J2; lam, J, zeta’); 
disp(’Closed Loop Poles=’) 
E=eig(A+B2*K) ; disp(E’) 
if any(real(E)>=0), 
err=4; 
return 
end 
4% alternate termination criteria (this is only a back-up to above) 
if iteration>?2, 
if (J==J2(iteration-1,2)) | iteration==100, 
break 
end 
end 


end 

7%, Determine the controller 
Y=iW(i:ma-..); 
W=YW(mati:matnq2,:); 

K=W/Y; 

74 plot the optimization history 


loglog(-J2(:,1),J2(: ,2),’?*’), grid, title(’Plant Costevs> Contromiler Siarcin » 
xlabel(’Controller Margin’) ,ylabel(’Plant Cost’) 


err=0; 
return; 


7% end plantopt2 


hinfres6 

function (F,Sf]J=hinfres6(AB,CD,B1B1,gam,Z) 
v/ 

% ({F,Sf]=hinfres6(AB,CD,B1B1,gam,Z) 


4 Description: 


%4, This function determines the a-matrix of the convex restriction 


yf | AB*¥YW + (AB*YW)’ + BiB1 (CD*YW)? | 
Pan) = | 2 70> 
y: | CD*YW -gam I | 

ue 

it 

PeInpUt s : 


h AB,CD,B1B1,gam parameters of the restriction 
% Z basis for YW from basis2 


% Outputs: 


% F a-matrix of the restriction 
% Sf block structure of F 


% Comments: 


%4, Note that in order to obtain the value of the restriction, we need a 
% vector x=[x1,...,xr], then F(x)=FO+F1l*xi+...Fr*xr, the block structure 
Fimiotwr (x) is Sf. 


4 this basis uses the reduced order problem 


{mz ,nz}=size(Z); 
{mm,nm}J=size(AB); 
[mr ,nrJ=size(CD); 
[ms ,ns]=size(B1B1); 
dim=nz/mn; mmar=mm+mr ; 
F=zeros (mmr ,mmr*dim) ; 
F(:,1:mmr)=[(B1B1,zeros(mm,mr) ;zeros(mr,mm) ,-gam*gam*eye(mr)] ; 
F3=zeros(mr) ; 
260% 1=1:dim, 
YW=Z(: , (i-1) *mm+1: (i-1)*mm+mn) ; 
F1=AB*YW; F2=CD*YW; 
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F(: ,i*mmr+1:(it+1)*mmr)=(F1+F1’ ,F2’;F2,F3]; 
end 
Sf=([1,mmtmr] ; 
return; 


¥%, end hinfres6 


hinfres4 


function (R,Sf]=hinfres4(Aa,Bla,B2a,YW,CD,gam) 
(R,SfJ=hinfres4(Aa,Bia,B2a,YW,CD, gam) 
Description: 


This function determines the a-matrix of the convex restriction 


AY+B2W+YA’+W’B2’+(CY+DW) ’ (CY+DW) B1 | 
<>O;, 

B1. - eye | 

4, = = 


| 
R(zeta) = | 
| 


A@inpucs: 


Aa,Bla,B2a are a-matrices of the plant 
YW,CD,gam parameters of the restriction (YW is the packed form [Y;W]) 


vA 

vA 

h 

% Outputs: 
h 

% R a-matrix of the restriction (-R>O is actually returned) 
% Sf block structure of R 


%, Comments: 


% Note that in order to obtain the value of the restriction, we need a 
% vector x=[x1,...,xr], then R(x)=RO+R1*x1+...Rr*xr, the block structure 
% of R(x) is Sf. 


(ma ,na]=size(Aa); dim=na/ma; 

[mb1 ,nb1]=size(Bla); nqi=nb1i/dim; 
[mb2 ,nb2]=size(B2a) ; nq2=nb2/dim; 
dimz=dim-1; 11=dimz+matnq1; 
Fi=(Aa(:,1:ma),B2a(:,1:nq2)]*YW; 

CYDW=CD*YW/gam; CYDW2= CYDW’ *CYDW; 
R=zeros(ii,dim*(ii)); F3=zeros(nq1); 


R(dim:i1,dim:i1)=-(F1+F1’+CYDW2, Bla(:,1:nq1); Bia(:,1:nq1)’,-eye(nq1)J; 
for 1=1:dimz, 
R(Ci,i+tii1*i)=1; 


Fi=({Aa(: ,i*ma+1:i*ma+ma),B2a(: ,i*nq2+1:i*nq2+nq2)]*YW; 
F2=Bia(: ,i*nq1+1:i*ngi+nq1) ; 
R(dim:i1, (i*ii+dim): (i*i1+i1))=-(Fi+F1’ ,F2;F2’ ,F3]: 
end 
Sf=[zeros(dimz,1),ones(dimz,1);1,matnqi]; 
return; 


%, end hinfres4 


2. Plant and Controller Optimization for an H,, Performance Con- 
straint at Multiple Flight Conditions 

The function plantopt5 solved the multiple flight condition problem. It 

called the identical subroutines as plantopt2 above, and differed only slightly in 

structure. During the first phase three mdependent controllers were calculated for 

the three respective flight conditions. The secoud phase then stacked the constraint 

functionals so as to jointly perform the plant optimization. The subroutine adiag 

performed the administrative task of stacking a-matrices for the imposition of joint 


constraints, and is documented in Appendix C. 


plantopt5 


tHumervon (zeta,xil,xi2,xi3,Z,J2,err}=... 
plantoptS(Aa,Bia,B2a,Aa2,Bila2,B2a2,Aa3,Bia3,B2a3,C,D,zeta, weight, gam, theta, prec) 


% (K,val,errJ=h2hinfstf(Aa,Bla,B2a,C,D,zeta,weight,gam,theta, prec) 
% (K,val,err]=h2hinfsf(Aa,B1a,B2a,C,D,zeta,weight, gam) 


%4 Description: 

% Given: 

% xdot = Ax + Biw + B2u, 
az = Cx Dou 
Ay = xX, 


% This function determines the minimum statefeedback plant satisfying 
“4% ||T_zw{||_infty < gamma 

min J=welght’*zeta 

subject to 


tre 
ss 
wit 


% R(Z)=AY+YA’?+B2W +W’B2’+B1i1B1’+(CY +DW)’ (CY +DW)< 0, 

yA 

% Code alternatively finds controller, and minimizing plant 
4% using the method of centers. 


% THIS CODE IS THE ANALOG TO PLANTOPT2 AND 
% FINDS THE SIMULTANEOUS OPTIMUM FOR 
7%, MULTIPLE FLIGHT CONDITIONS 


% Inputs: 


7% C,D are constant matrices from the state-space realization of the system. 
% Aa, Bla and B2a are a-matrices which hold the affine elements 

4% zeta is the vector that defines the initial plant (A=affin(AA,zeta) ) 

4 weight is the row vector of weights in the objective function 

% gam is a bound of the H-inf norm for the closed loop system. 

% theta parameter of the method of centers 

4% prec precision in the compute of the upper bound of the H2 norm. 


% Outputs: 


% K the gain 

4% val the optimum value of the performance index computed by centers 
h algorithm 

4 err error code, its value is err=1 if the problem is infeasible, 

vs otherwise err=0. 


4 Called functions: 

% basis, computes a basis for a set of block structured matrices 

4% hinfres, computes the a-matrix of a Riccati inequality restriction 
4 adiag, computes the a-matrix of diag(A(x) ,B(x)) 

4 atrace, computes the a-matrix of trace(R,X) 

4% aident, gives an a-matrix with the indept. term equals unity and 

h the rest of matrices zeros. 

4 getvec, gives the realization of a matrix in a matrix basis. 

4 affin, computes an affin matrix function. 


%, Comments: 


% The assumptions for this function are standard in the state-feedback 
% Hinf case, (A,B1) stabilizable and D1 has full column rank. 

“4 These assumptions are not checked, though they probably should be. 

4 If the inputs prec and theta are not provided, they are initialized 
7% to 0.1 and 0.001 respectively. 

if nargin==8 


theta=0.1; prec=.001; 
end 
{ma,na]=size(Aa); dimz=na/ma; 
[mb1,nbiJ=size(Bla); nqi=nb1/dimz; 
[mb2 ,nb2]=size(B2a) ; nq2=nb2/dimz; 


[me ,nc]=size(C); 
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% Flight Condition 1 

% Determine feasibility/controller 

A=affin(Aa,zeta); Bi=affin(Bia,zeta,nq1); B2=affin(B2a,zeta,nq2); 
a=A-B2*((D’*D)\D’)#*C; 

ham=(a, ((B1*B1’/gam~2)-B2*((D’*D)\B2’)); -C’*(eye(mc)-D*((D’*D)\D’))*C, -a’]; 


(x1,x2,failJ=ric_schr(ham); Xinf=x2/x1; 
if (fail>O) | any(eig(Xinf)<0), 
disp(’Initial System appears infeasible-1’); return 
else 
disp(’Initial Hinf problem feasible’ ) 
end 


Kp=-(D’*D)\(D’*C+B2’*Xinf); % controller 


% Determine particular soln from controller 


al=A+B2*Kp; bi=(B1,10000*sqrt(eps) *eye(ma)]; c1=C+D*Kp; 
foe fail )=ric_schr([ai',ci’*ci:—bi*b1’ ,-al)): Ypi=x2/x1; 
if (fail>O) | any(eig(Yp1)<0), 

disp(’Initial System appears infeasible-2’); return 
end 
Wp1=Kp*Yp1; 


% Flight Condition 2 

% Determine feasibility/controller 

A2=affin(Aa2,zeta); B1i2=affin(Bla2,zeta,nq1); B22=affin(B2a2,zeta,nq2); 
a=A2-B22*((D’*D)\D’ )#*C; 

ham=(a, ((B12*B12’/gam~2)-B22*((D’*D)\B22’));-C’*(eye(mc)-D*((D’*D)\D’))*C,-a’J; 


(x1,x2,failJ=ric_schr(ham); Xint=x2/x1 
if (fail>O) | any(eig(Xinf)<0), 
disp(’Initial System appears infeasible-1’); return 
else 
disp(’Initial Hinf problem feasible’ ) 
end 


Kp=-(D’*D)\(D’ *C+B22’*Xinf); % controller 


% Determine particular soln from controller 


ai=A2+B22*Kp; b1=(B12,10000*sqrt (eps) *eye(ma)] ; c1=C+D*Kp; 
fx tex 2 tall) =ric_schr([al’,ci’*c1;-bi*bi’ ,-al])): Yp2=x2/x1; 
if (fail>o) | any(eig(Yp2)<0), 

disp(’Initial System appears infeasible-2’); return 
end 
Wp2=Kp*Yp2; 


% Flight Condition 3 

% Determine feasibility/controller 

A3=affin(Aa3,zeta); Bi3=affin(Bia3,zeta,nq1); B23=affin(B2a3,zeta,nq2); 
a=A3-B23*((D’*D)\D’)*C; 

ham=[a, ((B13*B13’/gam~2)-B23*((D’*D)\B23’));-C’*(eye(mc)-D*((D’*D)\D’ ))*C,-a’J ; 


[xi x? ,fail]=ric_schr(hanm) ; Yini=x2/x1; 
if (fail>O) | any(eig(Xinf)<0), 
disp(’Initial System appears infeasible-1’); return 


Ail) 


else 

disp(’Initial Hinf problem feasible’ ) 
end 
Kp=-(D’*D)\(D’*C+B2’*Xinf);  % controller 


% Determine particular soln from controller 


a1=A3+B23*Kp; b1=[B13,10000*sqrt (eps) *eye(ma)]; c1=C+D¥*Kp; 
{x1,x2,failj=rice_schr(lal’ cl *c1,-b1ebl’ .-ai)- ¥p3=x2/ xii 
if (fail>O) | any(eig(Yp3)<0), 

disp(’Initial System appears infeasible-2’); return 
end 
Wp3=Kp*Yp3; 


y/ 
t 
% Initializing the optimization 


y/ 


(Z,YY,dimz]=basis2(ma,nq2); Syy=[1,ma]J; 
Rb=eye(ma+mc, (dimzt+1)*(ma+mc) ) ; Rc=(zeros(ma,ma) ,YY]; 
cb=[C DJ]; 

Ta=[0, weight]; Tb=eye(1,length(Ta)) ; 
J=weight*zeta; lam=-1; 
xil=getvec2(lLYp1;Wp1] ,Z); J2=U-) iteration—o. 


xi2=getvec2([Yp2;Wp2] ,Z); 
xi3=getvec2([Yp3;Wp3] ,Z); 


while lam<-1e-12, 


iteration=iterationtl 
y/ 
4% defining/solving the controller problem-flt cond 1 
vy 
disp(’searching for new controller- flt cond 1’) 
(Ra,Sc2J=hinfres6( (A B2],CD,B1i*B1’,gam,Z) ; 
lamin=max(eig(affin(Ra,xil))) + 0.1; 
([xiop,lam1,stat,err2]=centers3b(Ra,Rb,Rc,Syy,xii1, lamin, theta, prec,1e12); 
if err2™=0, 
err=3; return; 
elseif lam>=0, 
disp(’centers could not find a new feasible controller’ ) 
break 
elseif lam>-1e-6, 
disp(’feasible set too small to proceed’) 
break 
end 
YWi=affin( [zeros(matnq2,ma) ,Z],xiop,ma); 
X11=xiop; 


ve 
%4 defining/solving the controller problem-flt cond 2 
vA 


disp(’searching for new controller- flt cond 2’) 
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[Ra,Sc2]=hinfres6([A2 B22) ,CD,B12*B12’ ,gam,Z) ; 
lamin=max(eig(affin(Ra,xi2))) + 0.1; 
[xiop,lam2,stat,err2]=centers3b(Ra,Rb,Rc,Syy,xi2,lamin, theta, prec,1e12); 
if err27=0, 
err=3; return; 
elseif lam2>=0, 
disp(’centers could not find a new feasible controller (fc2)’) 
break 
end 
YW2=affin({zeros(matnq2,ma) ,Z] ,xiop,ma); 
X12=x10p; 


is 
% defining/solving the controller problem-flt cond 3 
ie 
disp(’searching for new controller- flt cond 3’) 
[Ra,Sc2)=hinfres6({A3 B23] ,CD,B13*B13’ ,gam,Z) ; 
lamin=max(eig(affin(Ra,xi3))) + 0.1; 
[xiop,lam3,stat,err2]=centers3b(Ra,Rb,Rc,Syy,xi3,lamin,theta,prec,1e12); 
if err27=0, 
err=3; return; 
elseif lam3>=0, 
disp(’centers could not find a new feasible controller (fc3)’) 
break 
end 
YW3=affin({zeros(ma+tnq2,ma) ,Z],xiop,ma) ; 
X13=x10p; 


i 
% defining/solving the min airframe problem 
Ve 
disp(’Optimizing plant for previous controller’) 
[Tc1,Sc1])=hinfres4(Aa,Bia,B2a,YW1,CD, gam); 
[Tc2,Sc2]=hinfres4(Aa2,B1a2,B2a2,YW2,CD,gam) ; 
[Tc3,Sc3]=hinfres4(Aa3,Bia3,B2a3,YW3,CD,gam) ; 
% use ’adiag’ to stack joint constraints 
To=adiag(Tc1,Tc2) ; Tc=adiag(Tc,Tc3);: 
Se-15¢1;Sc2;Sc3]; 
J=J+1000*eps; 
[zetaop,J,stat,err2]=centers3b(Ta,Tb,Tc,Sc,zeta,J,theta,prec,1le12); 
if err2~=0 

err=3; 

return; 
end 
zeta=Zetaop; 
A=affin(Aa, zeta) ; Bi=affin(Bla,zeta,nq1); B2=affin(B2a,zeta,nq2); 
A2=affin(Aa2,zeta); Bi2=affin(Bia2,zeta,nq1); B22=affin(B2a2,zeta,nq2) ; 
A3=affin(Aa3,zeta); B13=affin(Bla3,zeta,nq1); B23=affin(B2a3,zeta,nq2) ; 


Ji=[lami,lam2,lam3,J]; 
disp(J1) 


J2=(J2; lam1,lam2,lam3,J]; 
if iteration>2, 
if (J>0.999999*J2(iteration-1,4)) | iteration==50, 
break 
end 
end 


end 


¥%, Determine the controller 


Vi=¥Wi(i-ma: ): W1=YW1(ma+i:matnqg2,:); K1=W1/Y1; 
V2=(W 2 may.) W2=YW2(ma+1:matnq2,:); K2=W2/Y2; 
Va—YwWstlema..) W3=YW3(mati:matnq2,:); K3=W3/Y3; 


loglog(-J2(:,1),J2(:,4),’*',-J2(:,2) ,J2(: ,4),’+?,-J2(: ,3),J2(:,4),’x’), 
grid,title(’Plant Cost vs. Controller Margin’) 
xlabel(’Controller Margin’),ylabel(’Plant Cost’) 


err=0Q; 
return; 


% end plantopt5.m 


3. Joint H, Pole Placement Plant /Controller Optimization 

The function plantopt6 solves the plant/controller optimization problem 
where joint #7. and pole placement performance constraints are imposed. The 
structure is identical to the optimization functions above, and the algorithm follows 
section D.. The administrative functions hinfres6 and hinfres4 above create the 
basis matrices for the 7. constraint, while poleres1 and poleres2 create the basis 
matrices for the pole placement constraint. The administrative function adiag is then 
used to create the joint bases. 

The significant difference between this code and the previous codes is that 
the Riccati solvers prior to the beginning of the iterative routines could only find 
a controller that satisfies the H.. constraint, which was no guarantee of the exis- 


tence of a joint controller. The first pass through the algorithm therefore started 
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with a controller that was HH, feasible, but which most hkely failed to satisfy the 
pole placement constraint. The first pass therefore determined the feasibility of the 
problem. As mentioned in Chapter V, the failure of the algorithms to find a jointly 
feasible state-feedback controller did not by necessity mean that a feasible controller 


did not exist. 


plantopt6 


function 

[zeta,xi,K,Z,Ra,Tc,J2,errJ=... 
plantopt6(Aa,Bla,B2a,C,D,zeta,weight,rad,alpha,theta, prec) 

yf 

% (K,val,errJ=h2hinfsf(Aa,Bia,B2a,C,D,zeta,weight,gam, theta,prec) 

% (K,val,errJ=h2hinfsf(Aa,B1a,B2a,C,D,zeta,weight, gam) 

yp 


% Description: 


% Given: 

% xdot = A x + Biw + B2 u, 
Vaz = C x + D ou, 
4 yy = X, 


y 

% This function determines the minimum statefeedback plant satisfying 

% |tT_zwll_linfty < 1, and closed-loop poles in the circular disc of radius r 
% centered at (-(rad + alpha),O), 


% min J=weight’*zeta 
% subject to the following 


% RCZ)=AY+YA’+B2W +W’°B2’+B1B1’+(CY +DW)’ (CY +DW)< O, 


7%, and 

4, = ee 

tf | A1Y+YA1’?+B2W(I+A1/r)’+(I+A1/r)W’B2’+ A1YA1’/r B2*W | 

% R(Z)= | ecore 
yf ! W’B2’ =Y¥7r-. il 


% where A1=A + alpha*eye(A) 


% Code alternatively finds controller, and minimizing plant 
% using the method of centers. 


% Inputs: 


% C,D are constant matrices from the state-space realization of the system. 
% Aa, Bia and B2a are a-matrices which hold the affine elements 


Ww 
tO 
—-» 


% zeta is the vector that defines the initial plant (A=affin(AA,zeta)) 
% weight is the row vector of weights in the objective function 

% rad and alpha specify the circle 

% theta parameter of the method of centers 

% prec precision in the compute of the upper bound of the H2 norm. 


% Outputs: 


4% K the gain 

4% val the optimum value of the performance index computed by centers 
ys algorithm 

% err error code, its value is err=1 if the problem is infeasible, 

vA otherwise err=0. 


% Called functions: 

% basis, computes a basis for a set of block structured matrices 

% hinfres, computes the a-matrix of a Riccati inequality restriction 
4 adiag, computes the a-matrix of diag(A(x),B(x)) 

% atrace, computes the a-matrix of trace(R,X) 

4 aident, gives an a-matrix with the indept. term equals unity and 

yA the rest of matrices zeros. 

% getvec, gives the realization of a matrix in a matrix basis. 

% affin, computes an affin matrix function. 


%, Comments: 


% The assumptions for this function are standard in the state-feedback 

% Hinf case, (A,B2) stabilizable and D1 has full column rank. 

% These assumptions are not checked, though they probably should be. 

4% If the inputs theta and prec are not provided, they are initialized 

4% to 0.1 and 0.001 respectively. If the circle parameters are not specified 

% then they are set for a circle of radius 87.3, centered at -97.3 on the real 
% axis. 

if nargin<=9, 


theta=0.1; prec=.001; 
if nargin<9, 
rad=87 .3; alpha=0.5; 
end 
end 
([ma,na}]=size(Aa); dimz=na/ma; 
([mb1 ,nb1J=size(Bia); nqi=nb1i/dimz; 
[mb2,nb2]=size(B2a); ng2=nb2/dimz; 


[mc ,nce}]=size(C); 


% Determine hinf feasibility/controller 

gam=1 ; 

A=affin(Aa, zeta); Bi=affin(Bia,zeta,nq1); B2=affin(B2a,zeta,nq2); 
a=A-B2*((D’*D)\D’ )#*C; 

ham=[a, ((B1¥*B1’/gam~2)-B2*((D’*D)\B2’)); -C’*(eye(mc)-D*((D’*D)\D’))#C, -a’]; 
(x1,x2,failJ=ric_schr(ham) ; aint =x2/ xi 

if (fail>O) | any(eig(Xinf)<0), 


disp(’Initial System appears infeasible-1’); return 
else 

disp(’Initial Hinf problem feasible’) 
end 
Kp=-(D’*D)\(D’*C+B2’*Xinf);  % controller 


% Determine particular soln from controller 


al=A+B2+#Kp; bi=[B1,10000*sqrt(eps) *eye(ma)]; c1=C+D*Kp; 
(x1,x2,fail]=ric_schr([ai’ ,c1’*c1;-bi*b1’ ,-ai]); 
Yp=x2/x1; 
if (fail>O) | any(eig(Yp)<0), 
disp(’Initial System appears infeasible-2’); return 
end 
Wp=Kp*Yp; 


hh 

% Initializing the optimization 

h 

(Z,YY,dimz]=basis2(ma,nq2) ; Syy=[1,ma] ; 
Rb=eye(3*ma+mc, (dimz+1)*(3*mat+tmc)); Rc=[zeros(ma,ma) , YY]; 
GD=lc D]- 


Ta=(0, weight]; Tb=eye(1,length(Ta)); 
J=weight*zeta; lam=-1; 
xi=getvec2([Yp;Wp] ,Z); J2=(J; iteration=0; 


while lam<-1ie-6, 


iteration=iterationtl 
4 
% defining/solving the controller problem 
i 
disp(’searching for new controller’) 
[Ra1,SaiJ=hinfres6({A B2] ,CD,B1*B1’,gam,Z) ; 
[Ra2,Sa2]=poleres1(A,B2,rad,alpha,Z); 
% use adiag to form joint constraint 
Ra=adiag(Rai,Ra2); Sac=(Sai;Sa2;Syy]; 
lamin=max(eig(affin(Ra,xi))) + 0.1; 
[xiop,lam,stat,err2]=centers3d(Ra,Rb,Rc,Sac,xi,lamin,theta,prec,1e12); 
if err2°=0, 
err=3; return; 
elseif lam>=0, 
disp(’centers could not find a new feasible controller’) 
break 
elseif lam>-1e-6, 
disp(’feasible set too small to proceed’) 
break 
end 
YW=affin( (zeros(ma+nq2,ma) ,Z],xiop,ma) ; 
Y=YW(1:ma,:); W=YW(mat+1:matnq2,:); 
xi=xlop; 
K=W/Y; 


v/s 
% defining/solving the min airframe problem 
yE 
disp(’Optimizing plant for previous controller’) 
(Tc1,SciJ=hinfres4(Aa,Bia,B2a,YW,CD, gam) ; 
(Tc2,Sc2]=poleres2(Aa,B2a,rad,alpha,Y,W); 
Tce=adiag(Tc1,Tc2); Stac=(Sci1;Se2]; 
J=J+0.1; 
([zetaop,J,stat, err2]=centers3d(Ta,Tb,Tc,Stac,zeta,J,theta,prec,1lei2); 
if err2°=0 
err=3; 
return; 
end 
zeta=zetaop; 
A=affin(Aa, zeta); Bi=affin(Bla,zeta,nq1); B2=affin(B2a,zeta,nq2); 
disp(’ (Lambda, J]=’) 
disp((lam, J]) 
disp(’Closed Loop Poles=’) 
E=eig(A+B2*K) ; disp(E’) 
if any(real(E)>=0), 
err=4; 
return 
end 
J2=(J2; lam, J,zeta’]; 
if iteration>?2, 
if (J==J2(iteration-1,2)) | iteration==100, 
break 
end 
end 


end 

disp(’Final Closed Loop Poles=’ 
E=eig(At+B2*K) ; 

disp(E) 


logleog(~J2C: 71), 3205, 258 =) enadh 
xlabel(’Controller Margin’),ylabel(’Plant Cost’) 


err=0; 
return; 


% end plantopt6.m 
poleres] 


function [F,Sf]=poleresi(A,B,rad,alpha,Z) 
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% (F,Sf]=poleresi(A,B,rad,alpha,Z) 
% Description: Pole Placement constraint. 


% This function determines the a-matrix of the convex restriction 
| ALY+YA1’+BWCI+A1/r)’+(I+A1/r)W’B’+ ALYA1’/r BeW | 
% R(Z)= | I< 0. 
| W’B? -Yr | 


A anput s: 


% A,B,rad,alpha parameters of the restriction 
7% Z basis for YW from basis2 


% Outputs: 


%, F a-matrix of the restriction 
%, Sf block structure of F 


%, Comments: 


% Note that in order to obtain the value of the restriction, we need a 
% vector x=[x1,...,xr], then F(x)=FO+F1*x1i+...Fr*xr, the block structure 
eorex) is Sf. 


% this basis is for pole placement 


([mz,nz]=size(Z); 
(ma,na]=size(A); 
[mb ,nb]=size(B); 
dim=nz/ma; mm=2%*ma; 
F=zeros(mm,mm*dim) ; 
A1=A+alpha*eye(ma) ; 
for i=1:dim, 
Y=Z(1:ma, (i-1)*mat+1:(i-1)*matma) ; 
W=Z(mat+1i:matnb, (i-1)*mat1:(i-1)*matma) ; 
F2=B*w; 
F1=A1*Y + (Al/rad + eye(ma))*F2’; 
FC: ,i*mm+1:(iti1)*mm)=(F1+F1’+ (A1*Y*A1’/rad) ,F2;F2’ ,-Y*rad]; 
end 
Sf=(1,mn]; 
return; 


7% end poleres1 


poleres2 

function [F,Sf]=poleres2(Aa,B2a,rad,alpha,Y,W) 
4, (F,Sf]=poleres2(Aa,B2a,rad,alpha,Y,W) 
Description: 


% This function determines the a-matrix of the convex restriction 


vA = = 


ie | (A+B*K+alpha*eye)*Y+Y*(A+B*K+alpha*eye)’ (A+B*K+talphareye) | 
“% RCZ)= -| | > 3GR 
i (A+B*K+alpha*eye) -inv(Y/r) | 


7 - = 
fe 

/, Inpucs - 

74 rad,alpha,Y,W parameters of the restriction 


74 Aa, B2a bases for the plant 


7, Outputs: 
%, F a-matrix of the restriction (returns R>O) 
%, Sf block structure of F : 


%, Comments: 
% Note that in order to obtain the value of the restriction, we need a 
% vector x=[x1,...,xrJ, then F(x)=FO+Fi*xi+...Fr*xr, the block structure 


% of F(x) is Sf. 


74 this basis is for pole placement 


(ma,na}=size(Aa); mm=2*ma ; 

(mb ,nb]=size(B2a); 

dim=na/ma; nq2=nb/dim; 
F=zeros(mm,mm*dim) ; Fz=zeros(ma,ma); 
K=W/Y; 


Aja hate- ma) 

Bi=B2a(:,1:nq2); 

F1=Ai+Bi*K+eye(ma) ; 

FC: ,1:mm)=-[(F1*Y+Y*Fi’ ,F1;F1’ ,-inv(Y/rad)]; 


for 1=2:dim, 
Ai=Aa(: , (i-1)*ma+1:i*ma); 
Bi=B2a(:,(i-1) *nq2+1:i*nq2) ; 
F1i=Ai+Bi*K; 
FC: ,(i-1)*mm+1:i*mm)=-(F1*Y+Y*F1’ ,F1;F1’ ,Fz]; 
end 
Sf=([1,mm] ; 
return; 
7% end poleres2 
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4. Plant/Controller Optimization with a Joint H. Static Maneu- 
verability Specification 

The design code plantopt2a is a minor modification to the baseline HH. 

plant optimization code plantopt2. The static maneuverability specification must 

be posed as the basis (in €) to an LMI external to the routine. This basis Da is then 

passed to plantopt2a as an input variable. During the plant optimization phase of 

the routine, Da is diagonally augmented to the basis for the 7H. specification using 

adiag. Because the typical termination conditions are different than the standard 

plant optimization problem, the termination criteria was modified slightly. The code 

that follows is otherwise identical to plantopt2, and required no additional subrou- 


tines. 


plantopt2a 


funetion Lzeta.xi,K.Z,R&c,Tc,J2,err]=... 
plantopt2a(Aa,Bia,B2a,C,D,Da,zeta,weight,thres, gam, theta, prec) 

ih 

Plizetanx1 .K.zZ,Re,Tc,J2,errl=... 


i plantopt2a(Aa,Bia,B2a,C,D,Da,zeta,weight,thres,gam, theta, prec) 
vA 

% Description: 

% Given: 

Joexdow = A x + Bi w + B2 u, 

laaeeee= Cx + D u, 

Ay = x, 

A 

% This function determines the minimum state-feedback plant satisfying 
% ||T_zwl]_infty < gamma and a static manuverability spec posed by Da. 
A 

% min J=weight’*zeta 

% subject to 


% R(Cxi,zeta)= AY+YA’+B2W +W’B2’+ B1B1’+(CY +DW)’(CY +DW) < 0, 
y o 
7, and 


to 
to 
— J 


D(zeta) > 0 


Code alternatively finds central controller, and minimizing plant 
using the method of centers. 


Inputs: 


C,D are constant matrices from the state-space realization of the system. 

Aa, Bla and B2a are a-matrices which hold the affine elements 

zeta is the vector that defines the initial plant (A=affin(AA,zeta) ) 

weight is the row vector of weights in the objective function 

thres is the threshold on the central controller margin 

for determining when to quit the iterative procedure 

gam is a bound of the H-inf norm for the closed loop systen. 

theta parameter of the method of centers 

prec is used by the method of centers to determine when to quit the newton 
search for the analytic center. The default is 0.001, bur if the ricatti 
soln indicates that the problem is feasible and yet the method of centers 


cannot find a solution, then this parameter should be adjusted to something 


smaller to allow the newton search to go deeper. 

If the ricatti solvers indicate that the problem is feasible and yet the 
method of centers cannot find a feasible controller, then this parameter 
should be set smaller. 


Outputs: 


K the gain 

val the optimum value of the performance index computed by centers 
algorithm 

err error code, its value is err=1 if the problem is infeasible, 
otherwise err=0. 


Called functions: 

basis, computes a basis for a set of block structured matrices 

hinfres, computes the a-matrix of a Riccati inequality restriction 

adiag, computes the a-matrix of diag(A(x),B(x)) 

atrace, computes the a-matrix of trace(R,X) 

aident, gives an a-matrix with the indept. term equals unity and 
the rest of matrices Zeros. 

getvec, gives the realization of a matrix in a matrix basis. 

affin, computes an affin matrix function. 


Comments: 


The assumptions for this function are standard in the state-feedback 
Hinf case, (A,B1) stabilizable and D1 has full column rank. 

These assumptions are not checked, though they probably should be. 

If the inputs gam, prec and theta are not provided, they are initialized 
to 1, 0.1 and 0.001 respectively. 


if “nargin<11 


gam=1 ; theta=0.1; prec=.001; 
if nargin==7, 
thres=1e-6 

end 
end 
{ma ,na]=size(Aa); dimz=na/ma; 
[mb1 ,nbi]=size(Bia); nqi=nb1i/dimz; 
[mb2,nb2]=size(B2a); nq2=nb2/dimz; 


(mc ,nc]=size(C); 


74 Determine hinf feasibility/central controller 

A=affin(Aa,zeta);: Bi=affin(Bla,zeta,nq1); B2=affin(B2a,zeta,nq2); 
a=A-B2*((D’*D)\D’)*C; 

ham=(a, ((B1*B1’/gam~2)-B2*((D’*D)\B2’)); -C’*(Ceye(mc)-D*((D’*D)\D’))*C, -a’]; 


(xi1,x2,failJ=ric_schr (ham); Mant =% 27 21 
if (fail>O) | any(eig(Xinf)<0), 
disp(’Initial System appears infeasible-1’); return 
else 
disp(’Initial Hinf problem feasible’) 
end 


Kp=-(D’*D)\(D’*C+B2’*Xinf); % "central" controller 


% Determine particular soln from central controller 


al=A+B2*Kp; bi=(B1,10000*sqrt(eps)*eye(ma)]; c1=C+D*Kp; 
ieee x?) fail l=ric_schr([ai’ ,ci’*c1i:-bi*b1’ ,-a1]); Yp=x2/x1; 
if (fail>O) | any(eig(Yp)<0), 

disp(’Initial System appears infeasible-2’); return 
end 
Wp=Kp*Yp; 


y/ 
7% Initializing the optimization 


h 


(Z,YY,dimz]=basis2(ma,nq2) ; Syy=([1,ma] ; 
Rb=eye(matmc , (dimz+1)*(ma+mc)); Rc=(zeros(ma,ma) , YY] ; 
cb=[c DJ; 

Ta=(0, weight]; Tb=eye(1,length(Ta)); 
J=weight*zeta, lam=-1; 
xi=getvec2([Yp;Wp] ,Z); J2=()- iteration=0; 


while lam<-1le-12, 


iteration=iteration+1 

4 

% defining/solving the central controller problem 
h 

disp(’searching for new central controller’) 
(Ra,Sc2]=hinfres6([A B2],CD,B1*B1’,gam,Z); 
lamin=max(eig(affin(Ra,xi))) + 0.1; 


([xiop,lam,stat,err2]=centers3(Ra,Rb,Rc,Syy,xi,lamin, theta,prec,1ie12); 
if err2°=0, 
err=3; return; 
elseif lam>=0, 
disp(’centers could not find a new feasible controller’) 
break 
elseif lam>-thres, 
disp(’feasible set too small to proceed’ ) 
break 
end 
YW=affin( (zeros(ma+nq2,ma) ,Z],xiop,ma) ; 
Y=YW(i:ma,:); W=YW(mat+i:ma+nq?2,:); 
x1=x1op; 
K=W/Y; 


ys 
7 defining/solving the min airframe problem 
ip 
disp(’Optimizing plant for previous controller’) 
(Tc1,Sci]=hinfres4(Aa,Bia,B2a,YW,CD, gam) ; 
Te = adiag(Tc1,Da); 
Sc ([Se1;1 1]; 
J=J+.1; 
[zetaop,J,stat,err2]=centers3(Ta,Tb,Tc ,Sc,zeta,J,theta, prec,1e12); 
if err2°~=0 
err=3; 
return; 
end 
zeta=zetaop; 
A=affin(Aa,zeta); Bi=affin(Bia,zeta,nq1); B2=affin(B2a,zeta,nq2); 
disp([lam,J]) 
I2=[J2." lam. J ezeca lie 
disp(’Closed Loop Poles=’ ) 
E=eig(A+B24*K) ; disp(E’) 
if any(real(E)>=0), 
err=4; 
return 
end 
if iteration>2, 
if (J>0.999999*J2(iteration-1,2)) | iteration==100, 
break 
end 
end 


end 


%, Determine the controller 


Y=YW(1:ma,:); 
W=YW(ma+1:ma+nq2,:); 
K=W/Y; 


Mogleg(-J2(+,1),J2(2,2),°*’), grid,title(’ Plant Cost vs. Controller Margin’) 
xlabel(’Central Controller Margin’),ylabel(’Plant Cost’) 


err=0; 
return; 


% end plantopt2a.m 


5.  Plant/Controller Optimization with Dynamic Maneuverability 

Constraints 

As discussed in Chapter V, dynamic maneuverability requirements can ei- 
ther be imposed using a closed-loop H,. constraint or second formulation based upon 
determinantal relationships. For the first method, the original H. code plantopt2 
is suitable without modification. The following code, plantopt9 use the Lyapunov 
formulation. The subroutines actres1 and actres2 perform the formation of the 
bases matrices of the LMI associated with this constraint. 

In practice, plantopt2 was used for Example problem 5, and the following 
code routinely resulted in the method of centers departing the feasible set. ‘Tlnis 
suggests a feature in the geometry of the constraint which centers3 could not handle. 
Given more reliable interior point codes, and the fact that. both formulations were 
conservative, 1t would be interesting to see which of the two formulations for the 


dynamic maneuverability requirements resulted in a lower final plant cost. 


plantopt9 


funecion, [zeta,xi,K,Z,Ra,Tc,J2,errj=... 
plantopt9(Aa,Bla,B2a,B3a,C,D,zeta,weight,umax,thres, theta, prec) 


% (zeta,xi,K,Z,Ra,Tc,J2,errJ=... 
1, plantopt9(Aa,Bla,B2a,B3a,C,D,zeta,weight ,umax, theta, prec) 
% (zeta,xi,K,Z,Ra,Tc,J2, err)]=plantopt9(Aa,Bia,B2a,B3a,C,D,zeta,weight, umax) 


% Description: 


xdot = A x + Bi w + B2 u, 
z =O x + Deu, 
y = xX, 


This function determines the minimum state-feedback plant satisfying 
|\|T.zwl|_infty <1, and open-loop actuator limitation, 


min J=weight’*zeta 
subject to the following 


R(Z)= AY+YA’+B2W +W’B2’ + BiBi’ +(CY+DW)(CY +DW)’ < 0 
and 
F(Z) =AY+B2W+B3W(i,:)/u_max(i) + (CAY+B2W+B3W(i,:)/u_max(i))’ < 0 


Code alternatively finds central controller, and minimizing plant 
using the method of centers. 


Inputs: 


C,D are constant matrices from the state-space realization of the system. 


Aa, Bla, B3a and B2a are a-matrices which hold the affine elements 
Bia corresponds to the exogenous disturbance inputs 
B3a corresponds to the exogenous command inputs 

zeta is the vector that defines the initial plant (A=affin(AA,zeta)) 

weight is the row vector of weights in the objective function 

thres determines the central controller margin threshold at which 
the set of feasible control is considered too small to proceed 
Should usually be set to ie-6 to ie-10. Default=1e-9 

prec establishes how deep the newton search will proceed looking for 
the analytic center. Default=1e-6 


Outputs: 
Z2 output vector zeta of minimized plant parameters 
Xa vector of optimal controller parameters 


Called functions: 

basis, computes a basis for a set of block structured matrices 

hinfres, computes the a-matrix of a Riccati inequality restriction 

adiag, computes the a-matrix of diag(A(x),B(x)) 

atrace, computes the a-matrix of trace(R,X) 

aident, gives an a-matrix with the indept. term equals unity and 
the rest of matrices zeros. 

getvec, gives the realization of a matrix in a matrix basis. 

affin, computes an affin matrix function. 


Comments: 


% The assumptions for this function are standard in the state-~feedback 
%, Hinf case, (A,B2) stabilizable and Di has full column rank. 
% These assumptions are not checked, though they probably should be. 
% If the inputs theta and prec are not provided, they are initialized 
% to 0.1 and 0.001 respectively. 
if nargin==9, 

thres=ie-9; theta=0.1; prec=1e-6; 
else nargin<9, 

error(’Insufficent number of input arguments’ ) 


end 

{ma,na]=size(Aa); dimz=na/ma; 
{mb1,nb1J=size(Bia); nqi=nbi/dimz; 
(mb2 ,nb2]=size(B2a) ; nq2=nb2/dimz; 


{mc ,nc]=size(C) ; 


% Determine hinf feasibility/central controller 

gam=1; 

A=affin(Aa,zeta); Bizaffin(Bia,zeta,nqi) ; B2=affin(B2a,zeta,nq2) ; 
B3=affin(B3a,zeta,1); 

a=A-B2*((D’*D)\D’)*C; 

ham={a, ((B1*B1’/gam"2)-B2*((D’*D)\B2’)); -C’*(eye(mc)-D*((D’*D)\D’))#C, -a’]; 


(yiex2, fail )]=ric.schr(ham); Kint=x2/x1: 
if (fail>o) | any(eig(Xinf)<o), 
disp(’Initial System appears infeasible-i’); return 
else 
disp(’Initial Hinf problem feasible’) 
end 


Kp=-(D’*D)\(D’*C+B2’*Xinf);  % central controller 


% Determine particular soln from central controller 


ail=A+B2*Kp; bi={B1,10000*sqrt(eps)*eye(ma)]; c1=C+D*Kp; 
{x1,x2,failJ=ric_schr([ai’ ,ci’*c1:-bi*bi’ ,-ail]); 
Yp=x2/x1; 
if (fail>O) | any(eig(Yp)<0), 
disp(’Initial System appears infeasible-2’); return 
end 
Wp=Kp*Yp; 


¢ 
h 
% Initializing the optimization 


h 


(Z,YY,dimz]=basis2(ma,nq2) ; Syy=([1,ma]; 
Rb=eye(3*matmc, (dimz+1)*(3*mat+mc)); Rc=({zeros(ma,ma) , YY]; 
CD=[C D]; 

Ta={0, weight]; Tb=eye(1i,length(Ta)); 
J=weight*zeta; lam=-1; 
xi=getvec2((Yp;Wp] ,Z); J2=0| iteration=0; 


while lam<-1le-12, 


iteration=iterationti 


h 
% defining/solving the central controller problem 
yA 
disp(’searching for new central controller’) 
[Ra1,SaiJ=hinfres6({A B2],CD,B1i*B1’ ,gam,Z) ; 
[Ra2,Sa2]=actres1(A,B3,B2,umax,Z); 
Ra=adiag(Rai1,Ra2) ; Sac=[Sai;Sa2;Syy] ; 
lamin=max(eig(affin(Ra,xi))) + 0.1; 
[xiop,lam,stat,err2]=centers3d(Ra,Rb,Rc,Sac,xi,lamin,theta, prec, 1e12) ; 
if err2°=0, 
err=3; return; 
elseif lam>=0, 
disp(’centers could not find a new feasible controller’ ) 
break 
elseif lam>-thres, 
disp(’feasible set too small to proceed’) 
break 
end 
YW=affin( [zeros(matnq2,ma) ,Z],xiop,ma) ; 
Y=¥W(1i:ma,:); W=YW(mat+1:matnq2,:); 
X1=X1lop; 
K=W/Y; 


i 
7, defining/solving the min airframe problem 
i, 
disp(’Optimizing plant for previous controller’ ) 
[Tc1,Sci]J=hinfres4(Aa,Bia,B2a, YW,CD, gam) ; 
(Tc2,Sc2J=actres2(Aa,B3a,B2a,umax,W,Y); 
Tc=adiag(Tc1,Tc2); Stac=(Sc1:Sc2]; 
J=J+10; 
[zetaop,J,stat, err2]=centers3d(Ta,Tb,Tc,Stac,zeta,J,theta,prec,1e12); 
if err2”™=0 
err=3; 
return; 
end 
zeta=zetaop; 
A=affin(Aa,zeta); Bi=affin(Bla,zeta,nq1); B2=affin(B2a,zeta,nq2); 
B3=affin(B3a,zeta,1); 
disp(’{Lambda, J]=’) 
disp((lam, JJ) 
disp(’Closed Loop Poles=’ ) 
E=eig(A+B2*K) ; disp(E’) 
if any(real(E)>=0), 
err=4; 
return 
end 
J2=([J2; lam, Jo zeta. 
if iteration>?2, 
if (J==J2(iteration-1,2)) | i¢eration==100. 
break 


end 
end 


end 


disp(’Final Closed Loop Poles=’) 
E=eig(A+B2*K) ; 
disp(E) 


Hogtag(—J2(: ,1),J2(:;2),'*#") , grid, 
xlabel(’Central Controller Margin’),ylabel(’Plant Cost’) 


err=0; 
return; 


v, 


end plantopt6.m 


actres 1 


function (F,Sf]=actresi(A,B3,B2,umax,Z) 


(F,Sf]=actresi(A,B1,B2,umax,2Z) 

Description: Open-Loop constraint. 

This function determines the a-matrix of the affine restriction 
F(Z) =AY+B2W+B3W(i,:)/u_max(i) + (AY+B2W+B3W(i,:)/u_max(i))’ < 0 
Inputs: 


A,B1,B2,umax parameters of the restriction 
Z basis for YW from basis2 


Outputs: 


F a-matrix of the restriction 
Sf block structure of F 


Comments: 
Note that in order to obtain the value of the restriction, we need a 
vector x=(x1,...,xr], then F(x)=FO+Fi*xi+...Fr*xr, the block structure 


of F(x) is Sf. 


this basis is for open loop actuator limitations 


nu=length(umax) ; 
(mz ,nz]=size(Z); 
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[ma,na]=size(A); 
(mb3 ,nb3]=size(B3) ; 
(mb2 ,nb2]=size(B2) ; 
dim=nz/ma; 
F=(]; sft=-0; 
for k=1:nu, 
FO=zeros(ma,ma*(1+dim) ); 
for i=1:dim, 
Y=Z(1:ma,(i-1)*ma+1:(i-1)*ma+ma) ; 
W=Z(mat1:ma+nb2, (i-1)*mat+1:(1-1)*mat+ma) ; 
F1=A*Y+B2*W+B3/umax(k)*W(k,:); 
FO(: ,i#mati:(it+1)*ma)=F1i+F1’; 
end 
F=adiag(F,FO); 
Sf=(Sf;1,ma]; 
end 
return; 


% end actresil 


ActLes 7 


function (F,Sf]=actres2(Aa,B3a,B2a,umax,W,Y) 

(F ,Sf]=actres2(Aa,B3a,B2a,umax,W,Y) 

Description: Open-Loop constraint. 

This function determines the a-matrix of the affine restriction 
F(Z)=-(AY+B2W+B3W(i,:)/u_max(i) + (AY+B2W+B3W(i,:)/u_max(i))’) > 0 
Inputs: 


umax,Y,W parameters of the restriction 
Aa,Bla,B2a bases for the plant parameters 


4 Outputs: 


%, F a-matrix of the restriction 
% Sf block structure of F 


% Comments: 
% Note that in order to obtain the value of the restriction, we need a 


% vector x=[x1,...,xr], then F(x)=FO+F1*x1i+...Frexr, the block structure 
% of F(x) is Sf. 


% this basis is for open loop actuator limitations 


vA 


nu=length(umax) ; 
[ma,na]=size(Aa); 
[mb3 ,nb3]=size(B3a) ; 
(mw, nwj=size(W); 
dim=na/ma; 
if nb3>dim, error(’B3 matrix needs to have one column’),end 
F=(]; sf=0; 
for k=1:nu, 
FO=zeros(ma,ma*dim); 
for i=1:dim, 
Ai=Aa(:,(i-1)*mat+1:i*ma) ; 
B3i=B3a(:,i); 
B2i=B2a(: ,(i-1)*mwt1:i*mw); 
Fi=Ai*Y+B2i*W+B3i/umax(k)*W(k,:); 
FO(: ,(i-1)*ma+1:i*ma)=-(F1+F1’); 
end 
F=adiag(F, FO) ; 
Sf=(Sf;1,mal]; 
end 
return; 


% end actres2 


6. Plant/Controller Optimization with Robustness Constraints 
As discussed in Chapter V, the #{, constraint can be used to pose ei- 
ther disturbance rejection or robustness constraints on a plant optimization problem. 
The formulation of robustness constraints is slightly different than the imposition 
of turbulence rejection specifications due to the structure of the problem. A sepa- 
rate plant optimization function (plantopt10) was consequently required, as well as 
an additional subroutine (hinfres9) which could form the basis for the robustness 


constraint. 


plantopt10 


function [zeta,xi,K,Z,Ra,Tc,J2,err]J=... 
plantopt10(Aa,Bia,B2a,C,D,B3,C3a,D3a,zeta,weight ,thres theta, prec) 


[zeta, xa Keguka; 16,0 2neneli=a..- 
plantopti0(Aa,Bia,B2a,C,D,B3,C3a,D3a,zeta,weight,thres,theta, prec) 
Description: 
Given: 
xdot = A(zeta) x + Bi(zeta) w+ B2(zeta) u + B3 w3, 
Z = C Xoat D us, 
z3 = C3(zeta)x + D3(zeta) u 
y = x, 
This function determines the minimum statefeedback plant satisfying 


(ltezw| Weantty < 1, and |To23wsilintry <41- 


min J=weight’*zeta 
subject to the following 


R(Z)= AY+YA’+B2W +W’B2°+B1B1’+(CY +DW)’(CY +DW) < 0, 

and 

R(Z)= AY+YR'’ +B2W +W’B2"+B3B3"4+(C3) +D3y) (Coy ot DSh) Or 

Code alternatively finds central controller, and minimizing plant 
using the method of centers. 

This function was specifically intended to solve the hinf/hinf 
problem where T_z3w3 1s the uncertainty transfer function 


(and the plant parameters show up in (C3,D3)). 


Inputs: 


C,D,B3 are constant matrices from the state-space realization of the system. 
Aa, Bia, B2a,C3a, and D3a are a-matrices which hold the affine elements 


zeta is the vector that defines the initial plant (A=affin(AA, zeta) ) 
weight is the row vector of weights in the objective function 
thres determines the controller margin below which the routine quits 
theta parameter of the method of centers 

prec precision in the compute of the upper bound of the H2 norm. 


Outputs: 


K the gain 
err error code, its value is err=1 if the problem is infeasible, 
otherwise err=0O. 


Called functions: 

basis, computes a basis for a set of block structured matrices 
hinfres, computes the a-matrix of a Riccati inequality restriction 
adiag, computes the a-matrix of diag(A(x) ,B(x)) 

atrace, computes the a-matrix of trace(R,X) 
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4% aident, gives an a-matrix with the indept. term equals unity and 
yp the rest of matrices zeros. 

4, getvec, gives the realization of a matrix in a matrix basis. 

4 affin, computes an affin matrix function. 


7 Comments: 
% The assumptions for this function are standard in the state-feedback 


4% Hinf case, (A,B2) stabilizable and Di has full column rank. 
% These assumptions are not checked, though they probably should be. 


(ma,na]=size(Aa); dimz=na/ma; 
([mb1,nbi]J=size(Bla); ngi=nb1i/dimz; 
[mb2 ,nb2]=size(B2a) ; nqg2=nb2/dimz; 


(mc ,nc]=size(C); 
[mc3 ,nc3]=size(C3a); 


A=affin(Aa,zeta); Bi=affin(Bla,zeta,nql); B2=affin(B2a,zeta,nq2); 
C3=affin(C3a,zeta,ma); D3=affin(D3a,zeta,nq2); 


% Determine hinf feasibility/central controller 

gam=1; 

a=A-B2*((D’*D)\D’)*C; 

ham=(a, ((B1*Bi’/gam*2)-B2*((D’*D)\B2’)); -C’*(eye(mc)-D*((D’*D)\D’))*C, -a’]; 


(x1,x2,failJ=ric_schr(ham) ; Xinf=x2/x1; 
if (fail>oO) | any(eig(Xinf)<0), 
disp(’Initial System appears infeasible-1’); return 
else 
disp(’Initial Hinf problem feasible’) 
end 


Kp=-(D’*D)\(D’*C+B2’*Xinf) ; Yo central controller 


4% Determine particular soln from central controller 


al=A+B2*Kp; bi=(B1,10000*sqrt(eps)*eye(ma)]; c1=C+D*Kp; 
let) tai))=ric_schr([al’ ,c1’*c1;-bi*bi’ ,-ai]); 
Yp=x2/x1; 
if (fail>O) | any(eig(Yp)<=0), 
disp(’Initial System appears infeasible-2’); return 
end 
Wp=Kp*Yp; 


ie 

% Initializing the optimization 

i 

[Z, YY,dimz]) =basis2(ma,nq2) ; Syy=([1,ma] ; 
Rb=eye(2*matmct+mc3, (dimz+1)*(2*matmctmc3) ) ; 
Rc=(zeros(ma,ma) ,YY]; 


ep=([c D]: 
Ta=(0, weight]; Tb=eye(i,length(Ta)); 
J=weight*zeta; lam=-1; 
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xi=getvec2([Yp;Wp] ,Z); 12= (a iteration=0: 
while lam<-ie-12, 


lteration=literationti 
is 
4 defining/solving the controller problem 
if 
disp(’searching for new controller’) 
(Rai,SaiJ=hinfres6((A B2],CD,B1i*B1i’,gam,Z) ; 
(Ra2,Sa2]=hinfres6((A B2],(C3 D3] ,B3*B3’ ,gam,Z) ; 
Sac=(Sa1;Sa2;Syy]; 
Ra=adiag(Rai,Ra2) ; 
lamin=max(eig(affin(Ra,xi))); 
if lamin>=0, 
lamin=lamin*1.1; 
else, 
lamin=lamin+0.1; 
end 
(xiop,lam,stat,err2]=centers3d(Ra,Rb,Rc,Sac,xi,lamin,theta, prec, 1624) ; 
if err2°=0, 
err=3; return; 
elseif lam>=0, 
disp(’centers could not find a new feasible controller’ ) 
break 
elseif lam>-thres, 
disp(’feasible set too small to proceed’) 
break 
end 
YW=affin( {zeros(ma+ngq2,ma) ,Z] ,xiop,ma) ; 
Y=YW(i:ma,:); W=YW(mat1:matnq2,:); 
Xx1=xiop; 
K=W/Y; 


V6 
% defining/solving the min airframe problem 
ie 
disp(’Optimizing plant for previous controller’) 
(Tc1,Sci]=hinfres4(Aa,Bia,B2a,YW,CD, gam) ; 
(Tc2,Sc2]=hinfres9(Aa, B2a,B3,C3a,D3a, YW) 
Tc=adiag(Tc1,Tc2); Stac=(Se1;Se24; 
J=J+1; 
(zetaop,J,stat,err2]=centers3d(Ta,Tb,Tc,Stac,zeta,J,theta, prec, 1e24); 
if err27™=0 
err=3; 
return; 
end 
zeta=zetaop; 
A=affin(Aa,zeta); Bi=affin(Bia,zeta,nq1); B2=affin(B2a,zeta,nq2) ; 
C3=affin(C3a,zeta,ma); D3=affin(D3a,zeta,nq2) ; 
disp(’[Lambda, J]=’) 
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disp({lam,J]) 
disp(’Closed Loop Poles=’) 
E=eig(A+B2*K) ; disp(E’) 
if any(real(E)>=0), 
err=4; 
return 
end 
W2-1I2> lam, J,zeta’)* 
if iteration>2, 
if (J==J2(iteration-1,2)) | iteration==100, 
break 
end 
end 


end 

disp(’Final Closed Loop Poles=’ ) 
E=eig(A+B2*K) ; 

disp(E) 

if isempty(J2), return, end 
iomlogk=J2\:,1),J2(:,2),’*'), grid, 


xlabel(’Central Controller Margin’) ,ylabel(’Plant Cost’) 


err=0; 
return; 


% end plantopti0.m 


hinfres9 

function (R,Sf]=hinfres9(Aa,B2a,B3,C3a,D3a, YW) 
: (R,Sfl]=hinfres4(Aa,Bla,B2a,YW,CD, gam) 

% Description: 


% This function determines the a-matrix of the convex restriction 


y = zs 
Ke | AY+B2W+YA’+W’B2’+B3B3’ (C3Y+D3aW)~. | 

% R(zeta) = | | < 0, 

yA | (C3Y+D3W) - eye | 

Y = a 

% This subroutine was written for use with plantopt10 

% Note that zeta_i > 0 is not enforced since that is done by hinfres4 
yi 

% Inputs: 
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Aa,B2a,C3a,D3a are a-matrices of the plant 
YW,B3 constant parameters of the restriction (YW is the packed form [Y;W]) 


Outputs: 


y! 

y} 

y 

ip 

* 

% R a-matrix of the restriction (-R>0O is actually returned) 
% Sf block structure of R 
Y 

% Comments: 

% 

vA 

% 


Note that in order to obtain the value of the restriction, we need a 
vector x=[x1,...,xr], then R(x)=RO+R1*x1+...Rr*xr, the block structure 
¥-of Ras: St. 


[ma,na]=size(Aa); dim=na/ma; 
{mb2 ,nb2]=size(B2a); nqg2=nb2/dim; 
[mc3 ,nb3]=size(C3a); 
11=mat+mc3; 
R=zeros(ii,dim*(ii)); 
Fi=[Aa(:,1:ma) ,B2a(: ,1:nq2)] *YW; 
F2=(C3a(:,1:ma) ,D3a(;: ,1:nq2)) 
R(1:i1,1:11)=-(F1+F1’+B3*B3’, F2’;F2 ,-eye(nq1)]; 
F3=zeros(mc3); 
for i=1:dim-i, 
Fi=(Aa(: ,i*tmat+1:i*ma+ma) ,B2a(: ,i*nq2+1:i*nq2+nq2)] *YW; 
F2=(C3a(:,i*mat+1:i*ma+ma) ,D3a(: ,i#nq2+1:i*nq2+nq2)]*YW; 
R(dim:i1, (i*#ii+dim): (i*ii+i1))=-(F1+F1’ ,F2’;F2,F3]; 
end 
Sf=(1,,11). 
return; 


% end hinfres9 


7. Joint H, / Pole-Placement Plant/Controller Optimization 
A design code was also produced to solve the plant /controller optimization 
problem subject to a joint #2 /pole-placement performance constraint (plantopt8b). 
The H2 performance measure was not considered to be as useful as the HH. problem, 
and it was not used for any of the example problems. This code is consequently 
included for archival purposes only. The subroutines h2res1 and h2res2 prepared 
the basis matrices for the 7H, constraint. Interested readers should consult [Ref. 29] 


for a discussion of the generalized H cost. The derivation of the expressions used in 


these subroutines is straightforward from the expressions in this reference. 


plantoptsb 


function 
Pzecasyi K.Z,Ra,Re,J2,err)] =... 


yi 
h 


plantopt8(Aa,Bila,B2a,C,D,zeta, weight ,gam,theta, prec) 


[zeta,xi,K,Z,Ra,Tc,J2,err]=plantopt8(Aa,Bla,B2a,C,D1,D2,zeta,weight, gam, theta, prec) 
[zeta,xi,K,Z,Ra,Tc,J2,err]=plantopt8(Aa,Bia,B2a,C,D1,D2,zeta,weight) 


Description: 

Given: 

maou = A x + Bi w + B2 u, 
Z =, Cx + 2D 0, 
¥ = x, 


This function determines the minimum plant and associated state-feedback 
controller satisfying ||T_zw|/|_2(gen’1) < 1, and closed-loop poles in the 
circular disc of radius r, centered at (-(rad + alpha),0O). The 


min J=welight’*zeta 
subject to the following 


| AY+YA’+B2W +W’B2’ Bl 0 0 | 
R1(Z)= | Bl’ ~eye 0 0) | < 0, 
| 0 0 CYC’+DWC’+CW’D’-eye DW | 
| 0 0 W*D? Y | 
and 
PRIYA YA +B2WCI Ale oe rw Be ATYA1?/r B2*W | 
R2(Z)= | m0; 
| 


W’B2’ =e | 


where A1=A + alpha*eye(A) 


Code alternatively finds controller, and minimizing plant 
using the method of centers. 


Inputs: 


C,D1,D2 are constant matrices from the state-space realization of the system. 
Aa, Bla and B2a are a-matrices which hold the affine elements 

zeta is the vector that defines the initial plant (A=affin(AA,zeta)) 

weight is the row vector of weights in the objective function 

gam is a bound of the H-inf norm for the closed loop system. 

theta parameter of the method of centers 
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4% prec precision in the compute of the upper bound of the H2 norm. 
7% Outputs: 


% K the gain 

% val the optimum value of the performance index computed by centers 
yA algorithm 

% err error code, its value is err=1 if the problem is infeasible, 

te otherwise err=0. 


% Called functions: 

% basis2, computes a basis for Y and W 

% h2res, computes the a-matrix of the H-2 restriction 

% poleres, computes the a-matrix of the pole placement restriciton 
% adiag, computes the a-matrix of diag(A(x) ,B(x)) 

4% atrace, computes the a-matrix of trace(R,X) 

% aident, gives an a-matrix with the indept. term equals unity and 
h the rest of matrices zeros. 

4, getvec2, gives the realization of a matrix in a matrix basis. 

4, affin, computes an affin matrix function. 


7%, Comments: 


% The assumptions for this function are standard in the state-feedback 
% Hinf case, (C1,A,B2) detectable and stabilizable and D2 has full column rank. 
74 These assumptions are not checked, though they probably should be. 


% If the inputs gam,theta and prec are not provided, they are initialized 
% to 1,0.1 and 0.001 respectively. 
if nargin==8, 


gam=1; theta=0.1; prec=.001; 
end 
[ma,na]=size(Aa); dimz=na/ma; 
[mb1 ,nbi]=size(Bia); ngi=nb1/dimz; 
[mb2 ,nb2]=size(B2a) ; nqg2=nb2/dimz; 


[mc ,nc]=size(C); 


% Inital Plant 
A=affin(Aa,zeta); Bi=affin(Bia,zeta,nq1); B2=affin(B2a,zeta,nq2) ; 


% Find a good starting point (in the circle,Yp>0, and (A+BK)Y+Y(A+BK) ’+B1B1’<0) 
Poles=[(-5:-1:-4-ma] ; 


Kp=place(A,B2,Poles); 4 warning: place returns A-BK stable 
Yp=lyap((A-B2*Kp) ,B1*B1’); 

Yp=(Ypt+Yp’ )/2; % this corrects for inaccuracies in lyap 
Wp=-Kp*Yp; 


[Z, YY,dimz]=basis2(ma,nq2); 
xi=getvec2([Yp;Wp] ,Z); 


%, Admin 
CDb=fe bi- 
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Ta=[0, weight]; Tb=eye(1,length(Ta)); 
J=welght*zeta; lam=-1; 
J2= (1); iteration=O- 


%, Set the circle criterion 
rad=87 .3; alpha=1; 


while lam<-ie-6, 


iteration=iterationtl 
yA 
% defining/solving the controller problem 
yA 
disp(’Searching for new controller’) 
thaod , R2,S2)=h2re$1(3, [A B2).,,C,D,B1*B1’,Z); 
(R3,S3]=poleres1(A,B2,rad,alpha,Z); % poleres implicitly enforces Y>0O 
if iteration==1, 
% Mathematically the initial x1 found above should satisfy all but R2 
% Numerically it doesn’t work that well so we first need to find a feasible xi 
Ra=adiag(R1,R2); Ra=adiag(Ra,R3); 
Rb=eye(size(Ra)); 
Rc=[zeros(ma,ma),YY]; 
Sac=[S1;S2;S3;1,ma]; 
else, 
Ra=R1; 
% Note that the controller margin jumps since the objective function changes 
Rb=eye(ma, (dimz+1)*ma) ; 
Rc=adiag(-R2,-R3); 
Bac=1s1,52;S3); 
end 
lamin=max(eig(affin(Ra,xi))) + 0.1; 
(xiop,lam,stat,err2]=centers3d(Ra,Rb,Rc,Sac,xi,lamin,theta,prec,1e12); 
if err2°=0, 
err=3; return; 
elseif lam>=0, 
disp(’centers could not find a new feasible controller’) 
break 
elseif (iteration>1) & (lam>-1e-6), 
disp(’feasible set too small to proceed’) 
break 
end 
YW=affin([zeros(ma+nq2,ma),Z],xiop,ma) ; 
Y=YW(1:ma,:); W=YW(ma+1:matnq2,:); 
X1=xiop; 
K=W/Y ; 


1 

4 defining/solving the min airframe problem 

A 

disp(’Optimizing plant for previous controller’) 
vei Sci] =h2res2(Aa,Bla,B2a,Yu); 
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(Tc2,Sc2]=poleres2(Aa,B2a,rad,alpha,Y,W); 
Tc=adiag(Tc1,Tc2) ; Stac=[(Sci:Sc2); 
J=J+0.1; 
(zetaop,J,stat, err2)=centers3d(Ta,Tb,Tc,Stac,zeta,J,theta,prec,1e12); 
if err2™=0 
err=3; 
return; 
end 
zeta=zetaop; 
A=affin(Aa,zeta); Bi=affin(Bla,zeta,nq1); B2=affin(B2a,zeta,nq2) ; 
disp(’ (Margin, J]=’) 
disp([lam,J]) 
disp(’Closed Loop Poles=’ ) 
E=eig(A+B2*K) ; disp(E’) 
if any(real(E)>=0), 
err=4; 
return 
end 
J2=(J2; lam, J]; 
if iteration>2, 
if (J==J2(iteration-1,2)) | iteration==100, 
break 
end 
end 


end 


disp(’Final Closed Loop Poles=’) 
E=eig(A+B2*K) ; 
disp(E) 


loglog(-J2(:,1),I2G:32) 42%") , guid, 
xlabel(’Controller Margin’) ,ylabel(’Plant Cost’) 


err=0; 
return; 


% end plantopt8.m 


h2res] 


function [F,Sf,R,SrJ=h2resi(f,AB,C,D,B1B1,Z) 
vA 

% (F,Sf,R,Srj=h2resi(f,AB,C,D,B1B1,2Z) 

Ht 

% Description: 

A 


% This function determines the a-matrices of the affine restrictions 
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% associated with the generalized H_2 constraint. 
7%, The input ’f’ specifies whether the H_2 constraint is to use the 
4% max eigenvalue (f=2) or the maximum diagonal element (f=3). 


i 1) F=AB*YW + (AB*YW)’ + B1B1 <0) 

he and 

ie 2a) f=2: R= | CYC’ +DWC’+CW’D’-eye DW | 

vA 1 eee? =i | <0 

vs or 

ys 2b) f=3: R= | diag(diag(CYC’ +DWC’+CW’D’-eye) ) DW | 
A [| W’D? -Y | <0 
h 

i, Note that Y>O is implicitly enforced within R<O. 

y/ 

% Inputs: 


% AB,C,D,BiBi parameters of the restriction 
% Z basis for YW from basis2 


/acutputs : 


%, F a-matrix of the restriction 
%, Sf block structure of F 


¥% Comments: 


% Note that in order to obtain the value of the restriction, we need a 
% vector x=(xi,...,xr], then F(x)=FO+Fi*xi+...Fr*xr, the block structure 
Peoteh(x) is Sf. 


[mz ,nz]=size(Z); 

imeencl=size(C): 

dim=n2/nc; mm=nc+mc; 
F=zeros(nc,nc*dim) ; 

R=zeros(mm,mm*dim) ; 


FC: ,1:nc)=B1B1; 
R(1i:mc,i:mc)=-eye(mc); 


for 1=1:dim, 


Y=Z(iinc, (1-1) *ne+1:(1i-1)*nctnc) ; W=Z(nct+1:mz, (1-1) *nct+1:(i-1)*nctnc); 
Fi=AB*(Y;W]; 

DW=D*W; 

FC: ,i*nc+1:(it1)*nc)=F1i+F1’; 

if f==3, 


RC: ,i*mmt+1:(i+1)*mm)=(diag(diag(C*Y*C’ +DW*C’+C*DW’)),DW;DW’ ,-Y]; 
elseif f==2, 

RC: ,i*mm+1:(it+1)*mm)=[(C*Y*C’ +DW*C’+C*DW’) ,DW;:DW’,-Y]; 
else, 

error(’f must equal either 2 or 3 in h2res1’ ) 
end 


end 

St= (iene ie 
Sr=[1,nct+mc]; 
return; 


vA 


end h2resi 


heres 


function [R,Sf]=h2res2(Aa,Bia,B2a, YW) 


(R,Sfj=h2res2(Aa,Bia,B2a, YW) 
Description: 


This function determines the a-matrix of the convex restriction 


| AY+B2W+YA’+W’B2’ ein | 
R(zeta) = | 1 <0, 
| isle 


and zeta>0O 
Note that the second part of the H_2 constraint (eye-(C+DK)Y(C+DK)’>0) 
1s independent of zeta! 
Note also that R(zeta) is independent of the method by which the 
H-2 constraint 1s imposed. 


Inputs: 


Aa,Bia,B2a are a-matrices of the plant 
YW,gam parameters of the restriction (YW is the packed form [Y;W]) 


Outputs: 


R a-matrix of the restriction (-R>O is actually returned) 
Sf block structure of R 


Comments: 
Note that in order to obtain the value of the restriction, we need a 


vector x=(x1,...,xr], then R(x)=RO+R1*xit+...Rr*xr, the block structure 
of R(x) is Sf. 


(ma,na]=size(Aa); 
(mb1 ,nb1i]=size(Bia) ; 
(mb2,nb2]=size(B2a) ; 
dimz=dim-1; 
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dim=na/ma; 
nqi=nbi/dim; 
nqg2=nb2/dim; 
11=dimz+mat+nqi ; 


Fi=[Aa(:,i:ma),B2a(:,1:nq2)J]*YW; 
R=zeros(i1,dim*(i1)); F3=zeros(nq1); 
Redan: 11,dim:21)=-[F1+F1", Bia(;:,1:nqi); Bia(:,1linq1)’, ~eye(nd1)]; 
for 1=1:dimz, 
R(i,itii*i)=1; 
Fi=(Aa(:,i*ma+i:i*matma) ,B2a(:,i*nq2+1:i*nq2+nq2)] *YW; 
F2=Bia(:,i*nqi+1:i*nqitnq1); 
R(dim:121,(i*i1+dim):(2*11+i11))=-(F1+F1’ ,F2;F2’ ,F3] ; 
end 
Sf=[(zeros(dimz,i),ones(dimz,1);1,ma+nq1]; 
return; 


% end h2res2 


B. EXAMPLE SCRIPTS 

This section documents the scripts which were used in the preparation of the 
example problems of Chapter V. The principal objective of these scripts is to take 
the linear aerodynamic coefficients and translate them into an open-loop state space 
representation that reflects the dependence on the optimization variables of interests. 
The outputs Aa,B1a,B2a,C and D are then the primary inputs to the optimization 
functions in the section above. The section below follow the order in which the 
examples were introduced in Chapter V. 

1. Example 1- Optimal Vertical Tail at a Single Flight Condition 

This script executes the directional dynamics example illustrated in Chap- 

ter V. The stability derivative data for a F-4 aircraft in the power approach flight 
condition was extracted from [Ref. 37]. The functional dependence of the tail size was 
determined using the relationships in [Ref. 40] to break the stability derivative data 
ito its taal and wing/body contributions. The formulae for the plant can be found in 
equations 5.16. This script also provides the plant bases for Example problems 3 and 


4. 


ft opt Ib 


% Flight condition 1 
% Approach 


4 Script establishes a directional aircraft plant for 
% optimization of all-moving vertical tail. 


7, f-4 data 

rho=0.00238; % slugs/ft~3 

V=230; % fps 

1zz=133700; 4% slug-ft2 

S=530; omeet 2 wing area 

b=38.7; Ae wing span 
Sb=243.86; eet Gd body surface area 
1b=53.12; eat body length 
1t=19.8; fp oe tail position from cg 
Tmax = 20000; 

le = 2.0; 


umax = 30/57.3; 


Cnbwb=-0.00107; % yaw moment due to beta (wing/body) 
Cybt=0.425; % side force due to beta (tail) 
q=0.5*rho*V*V; Lub t/ tta2 

sigmabeta=0.043; % variance on disturbance 


7% build functional state-space representation 

AO=(0 1;-Izz\q*S*b*Cnbwb -Izz\2*q*S*b*(1t/V)*Cnbwb] ; 
A1=([0 0;-Izz\q*S*b*Cybt -Izz\2*q*S*b*(1t/V)*Cybt] ; 
Aa=(AO Al); 


B10=(0 -Izz\q*S*b*Cnbwb] ’; 
B11=(0 -Izz\q*S*b*Cybt] ’; 
Bia=(B10 BiiJ]*sigmabeta; 


B20=(0 0]’: 
B21=([0 -Izz\q*S*b*Cybt] ’; 
B2a=(B20 B21]; 


% initial parameters 


Vto=0.47; % original tail volume 
Vro=0.3*Vto; % original relative rudder volume 
zeta=[Vto 2 

weight=(1 J; 


% original dynamics 
Ao=affin(Aa, zeta); 
B20o=affin(B2a,zeta,1); 


% Sigmabeta is variance on beta disturbances 


B1=(0; -Izz\q*S*b*(Cnbwb+Cybt*Vto)]*sigmabeta; 
c=[1/0.035 0; 0 0); 
D=(0- 1/0. 175] ; 


DRdyn=eig(Ao) ; 
nat_frq=abs(DRdyn(1)); 
damping=-cos(angle(DRdyn(1))); 


% Construct the basis for the static moment problem (example 4) 
Do = -Tmax*le; 

Bi q*S*b*Cy bt *umax ; 

Da = [Do,D1]; 


4 end F4_opt_1b 


2. Example 2- Optimal Vertical Tail at Multiple Flight Conditions 

The following two scripts prepared the vertical tail optimization problem 

at high subsonic and supersonic flight conditions. These were then used in concert 

with the script in the above slow speed script to perform the multiple flight condi- 

tion example problem. The synthesis model is different from the script above in two 

respects. First of all, the stability derivatives reflect the values appropriate to the 

various flight conditions. Secondly, the turbulence rejection specification is signifi- 

cantly different, and required different scaling of the input and output vectors w and 

z. Scaling of w was reflected in the C’ and D matrices, wlile scaling of w was reflected 
in the B, and D matrices. 


f4 opt 2b.m 


4 Flight condition 2 
%, Subsonic cruise 


% Script establishes a directional aircraft plant for vertical optimization. 


74 £-4 data 

rho=0.000739; % slugs/ft~3 

V=876; 4 fps 

Izz=139800; 4% slug-ft~2 

S=530; Late 2 wing area 


es, 
eat | 
oy 


b=38.7; Tape Ge wing span 


Sb=243. 86; Aatt—2 body surface area 

1b=53.12; %, ft body length 

1t=19°..8: eit tail position from cg 
Cnbwb=-0.00125; % yaw moment due to beta (wing/body ) 
Cybt=0. 266; % side force due to beta (tail) 
q=0.5*rho*V*V; Leib /it 2 

sigmabeta=0.0057; % variance on disturbance 


% build functional state-space representation 

AO=(0 1;-Izz\q*S*b*Cnbwb ~Izz\2*q*S*b*(1t/V)*Cnbub] ; 
A1=[0 0;-Izz\q*S*b*Cybt -Izz\2*q*S*b*(1t/V)*Cybt] ; 
Aa2=[AO Ai]; 


Bi0=[(0 -Izz\q*S*b*Cnbwb] ’; 
B11=[0 -Izz\q*S*b*Cybt] ’; 
Bia2=(B10 Bii]*sigmabeta; 


B20=(0 O17 
B21=([0 -Izz\q*S*b*Cybt]’; 
B2a2=(B20 B21); 


4% initial parameters 


Vto=0.47; 4 original tail volume 
Vro=0.3*Vto; % original relative rudder volume 
zeta=[Vto ]’; 

weight=(1 ]; 


% sigmabeta is variance on beta disturbances 
B1=(0;-Izz\q*S*b*(Cnbwb+Cy bt *Vto)]*sigmabeta; 

C=[1/0.035 0; 0 0]; % weights rms beta to be less than 2 deg 

D=([0;1/0.175] ; % weights rms rudder deflection to be less than 10 deg 


Onision 


% Flight condition 3 
% Supersonic cruise 


4 Script establishes a directional aircraft plant for vertical tail optimization. 


%4 £-4 data 

rho=0.000287; % slugs/ft~3 

V=1742; “4, fps 

Izz=139800; % slug-ft 2 

S=530; ett eZ wing area 

b=38.7; JA ue wing span 

Sb=243. 86; (ete 2 body surface area 
1b=53.12; ¥, ft body length 

1t=19.8; ott tail position from cg 
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Cnbwb=-0.00133; % yaw moment due to beta (wing/body) 


Cybt=0.193; 4 side force due to beta (tail) 
q=0.S5*rho*V*V; ool? tc. 2 
Ssigmabeta=0.0029; % variance on disturbance 


% build functional state-space representation 

AO=(0 1;-Izz\q*S*b*Cnbwb -Izz\2*q*S*b*(1t/V) *Cnbwb] ; 
A1=[0 0;-Izz\q*S*b*Cybt -Izz\2*q*S*b*(1t/V)*Cybt] ; 
Aa3=[AO A1 ); 


B10=[0 -Izz\q*S*b*Cnbwb] ’ ; 
B11=[0 -Izz\q*S*b*Cybt] ’; 
Bia3=(Bi0 Bii]*sigmabeta; 


B20-10)' 01’: 
B21=(0 -Izz\q*S*b*Cybt]’; 
B2a3=(B20 B21]; 


% initial parameters 


Vto=0.47; % original tail volume 
Vro=0.3*Vto; % original relative rudder volume 
zeta=[Vto]’; 

weight=[1 ]; 


% sigmabeta is variance on beta disturbances 

B1i=(0; -Izz\q*S*b*(Cnbwb+Cybt*Vto) ]*sigmabeta; 

G=|170=035 0: 0 0]: 4% weights rms beta to be less than 2 deg 
D=(0;1/0.175); 4 weights rms rudder deflection to be less than 10 deg 


3. Example Three- Optimal Vertical Tail for Joint H, Pole-Placement 
Specification 
The Joint H,, Pole-Placement example problem used the identical set up 
script as example one above. The difference was that a different optimization function 
code was exercised (plantop6 for the joint constraint in lieu of plantopt2 for the 


pure HH. constraint). 


4. Example Four- Optimal Vertical Tail for Joint H., Static Moment 

Specification 

Example Four used the identical set up script as example one above. The 
difference was that a different optimization function code was exercised (plantop2a 
for the joint constraint in heu of plantopt2 for the pure #(,, constraint). 

5. Example Five/Six- Plant and Controller Optimization with Ma- 
neuvering Constraints 

The following script creates the bases for the longitudinal F-14 autoland 
problem. The aerodynamic derivative data was extracted from [Ref. 48], and the 
decomposition into the wing/body and horizontal tail contributions is in accordance 
with [Ref. 40]. The coding of the flight dynamics equations was verified by a cross 
check of the nominal plant (¢ = [1. 1]7) with a linear plant extracted from a lin- 
earization of the nonlinear equations used for the design examples of Chapter IV. 
This routine does provide the bases for uncertainty modeling, though this was not 
successfully demonstrated in an example problem. 

This model does not include actuator dynamics. Predecessors did include 
actuator dynamics, but problems were encountered in solving the initial feasibility 
problem using either Riccati or interior point methods. These problems were at- 
tributed to the stiff geometry that the actuator poles introduced. See the script for 
further comments regarding its use. 

The plant optimization function plantopt2 was used for Example Five, 
while plantopt2a was used for Example Six. In the later two cases, the maneu- 
verability constraint was passed into the optimization function through the input 


variable Da. 


bo 
qr 
les 


One aspect of this physical example is contrived. Specifically, the thrust 
was fixed for the problem and not used as a control input. This was necessary in 
the absence of actuator models, for otherwise the optimization routine shifted all the 
control energy into thrust in order to collapse the aerodynamic surface sizes. 

An important practical issue relevant to the subject of the general prob- 
lem’s geometry was observed during these experiments. The method of centers code 
centers3 has a numerical input argument prec which determines the termination 
criteria for the Newton search for the analytic center. It essentially determines how 
deep the search must. go before it is considered to be “close enough” to the optimal 
value. In a strictly affine problem prec is related to the precision of the final output 
relative to the optimal value. The default for this value had been set to 107%, which 
would ensure that the output was within 0.lof the optimal value. Because of our 
methodology in employing the method of centers in alternating directions across the 
feasible set, this was no longer true. The output for the above problems could vary 
as much as a factor of 20 if prec was not set low enough. As prec was adjusted 
from 107% to 107°, the total cost at the conclusion of one set of trials improved by 
a factor of nearly 20. No further improvement was then noted as prec was adjusted 
Hom 10° to 107°. 


eeopt 3.m 


% Establishes plant matrices for flight path control problem with 
% stab and DLC control power adjustable. 
% Thrust and actuators have been removed. 


% This problem is hinf feasible, but not jointly hinf and pole-placement 
% feasible for (87.3,1) circle. 

% Converges successfully with plantopt2 (hinf only). 

% The precision argument for plantopt2 must be set to 1le-6 or smaller 

% to find the feasible controller. 


IN 
un 
wr 


g=32.174; 4 fps 

m=54000/¢; % slugs 

Ly y=247194; % slug-ft~2 

S=565 ; yA 08 ae 

cbar=9.8; 4 ft 

U=134*1.6889; 4 ips 

M=2.203; 

p=2116; 4, lei fcr 2 

Q=.7*p*M*M; 4 lbf/ft~2 

alpha=11.4/57.3; % rad 

u0=cos (alpha) *U; 

thO0=alpha; % rad - trim point is level flight 
sigma_cmd=3/57 .3; % rad 

sigma_alpha=5/U; % xad 

omega1=40; % rad/s - Actuator bandwidths 
omega2=80; %, rad/s 

omega3=5; % rad/s 

rho1=0.1; % DLC drag to lift ratio 
rho2=0; % DLC moment to lift ratio 


%, F-14 stability derivative data 
CLt=1.49534913; 
CDt=0.37405269 ; 


CMt=0; 
CDU=0; 
CLU=0; 
CMU=0; 
CDA=0.0208*57.3; % rad~-1 
CLA=0.0799*57.3; % rad~-1 
CMA=-0.0115*57.3; % rad~-1 
CLQ=5.45; % rad7~-1 
CMQ=-14.3; % rad~-1 
CLAD=-0.51; % rad~-1 
CMAD=-0.93; % rad~-1 
CLIS=0.0141*57.3; % rad~-1 
CMIS=-0 .0201*57.3; % rad~-1 


% Scale initial DLC for -0.1 g accel at full deflection of 0.5 rad 
CLDLC=-0.1*CLt/0.5; % rad~-1 

CDDLC=rho1*CLDLC; % rad~-1 

CMDLC=rho2*CLDLC; 


% Determine the wing body derivatives: 

xc=-CMIS/CLIS; % ratio of tail lever arm to mean chord 
CDAwb=CDA; 

CLAwb=CLA-CLIS; 

CMAwb=CMA-xc*CLIS; 

CLOQWb=CLQ-2*xc*CLIS; 

CMQwb=CMQ+2*xc°~ 2¥*CLIS; 

CLADwWb=CLAD+2*xc*CLIS; 
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CMADwb=CMAD-2*xc~2*CLIS; 


% determine Rotation Matrix from Lift/Drag to body axis 
T=(-cos(alpha) sin(alpha) 0;-sin(alpha) -cos(alpha) 0;0 0 cbar]; 
QT=Q*S*T; 

e2U—cbar/2/U; 


7, Determine Corrected Inertia Matrix 
J=diag((m*U ,m*U,Iyy,1])-[c2U*QT*[O0 0 0;0 CLAD 0;0 CMAD 0 ],[0;0;0];0 0 0 0]; 


% Build aero blocks of state matrices 

4 states are u,alpha,q,theta,alpha/s,gamma_er/s 

aQ0=(2*CDt -CLt 0;2¥*CLt CDt 0; 2*CMt O O]; 

a01i=(CDU/U CDAwb 0; CLU/U CLAwb CLQwb*c2U;CMU/U CMAwb CMQwb*c2U] ; 
a0=(QT*(a00+a01) ,-m¥g*(cos(th0O);sin(thO);0]; 00 1 0]; 
a0(1:2,3)=m*U*(-sin(alpha) ;cos(alpha)]+a0(1:2,3); 

a1=(QT*CLIS*(0 0 0;0 1 2*xc¥*¥c2U; O xc -2*xc~2*c2U] ,[0;0;0];0 00 0]; 
a2=zeros (4,4); 

aO=J\a0; ai=J\al; 


% control inputs are stab(rad),DLC (rad), thrust(lbf) 
bO=zeros(4,2); 

bi=J\(QT*(O 0;CLIS 0;CMIS 0];0 0]; 

b2=J\([QT*[0 CDDLC;0 CLDLC ;0 CMDLC ];0 0 ]; 


% Build system matrices 
AO=zeros(6,6); A1=A0; A2=A0; 


A0(1:4,1:4)=a0; A1(1:4,1:4)=al1; Aiea 4 Sa2 - 
AO(5,2)=1; 
A0(6,(2,4])=(-1 1]; 


Aa=[AO A1 A2]; 


% exogenous inputs alpha_dist, gamma_cmd 
BiO=ezeros(6,2): Bi1=B10; B12=B10; 


B10(1:4,1)=a0(: ,2)*sigma_alpha; B10(6,2)=-sigma_cmd; 
B11(1:4,1)=a1(:,2)*sigma_alpha; 

B12(1:4,1)=a2(:,2)*sigma_alpha; 

Bia=(B10 Bii B12); 

B20-) 150: 0 0:0 0]: B21=(b1; zeros(2,2)]; B22=(b2: zeros(2,2)]: 
B2a=(B20 B21 B22]; ‘% factor required to achieve hinf feasibility 

% Build Output matrices 

ui 


74 z=(stab,DLC,alpha/s,gamma_err/s,alpha] 
y/ 


C=zeros(5,6); Di=zeros(5,2); D2=eye(5,2); 
C(3:4,5:6)=eye(2); 
CCS) 2) =1- 


% Output criteria: 

% stab<20 deg 

% DLC <40 deg 

% alpha_err< 1.5 deg 


zScale=diag((57.3/20,57.3/40, .00001, .00001,57.3/1.5]); 
C=zScale*C; D1=zScale*D1; D2=zScale*D2; 


zeta=(10;10]; 
wgt=(3,1]; 


% Build system matrices for uncertainty inputs and outputs 
Delta=0.1*eye(6,3); % Scaling for 10% uncertainty 
B3=Delta*QT; 

C3_0=QT\J(1:3,1:3)\QT*[a01,zeros(3,3)]; 

C3_.1=(0T\al(1:3.-), zeros(3,2) 1. 

C3a=(C3_0,C3_1,zeros(3,6)]; 

D3a=QT\B2a(1:3,:); 


% Add open loop requirement to maintain a max neg. pitch rate 
% of 0.2 rad/sec for elev. deflection from trim of -20 deg 


de_max = -20; 


q_max = 0.2; 

EO = A0(3,3)*q_max + B20(3,1)*de_max/57 .3; 
E1 = A1(3,3)*q_max + B21(3,1)*de_max/57.3; 
E2 = Q; 

Ea = (EO Ei E2]; 


7% end £14_opt_3 


6. Example Seven- Plant and Controller Optimization with Maneu- 


vering Constraints and Directed Thrust 


The following script is nearly identical to the script above, with the excep- 


tion of the inclusion of directed thrust. The directed thrust shows up principally in 


the By matrix where it influences both the closed-loop controller, and the open-loop 


maneuverability constraint. The maneuverability specification is identical to that 
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applied for Example Six. 


{14 opt 4 


% Establishes plant matrices for flight path control problem with 
% stab and DLC control power adjustable. 


% Thrust and actuators have 


been removed. 


% This problem is hinf feasible, but not jointly hinf and pole-placement 
7, feasible for (87.3,1) circle. 

”% Converges successfully with plantopt2 (hinf only). 

% The precision argument for plantopt2 must be set to 1e-6 or smaller 

% to find the feasible controller. 


g=32.174; “4 fps 

m=54000/¢ ; % slugs 

Ly y=247194; 7% slug-ft 2 

S=565: ; A ae 

cbar=9.8; Anes & 3 

U=134*1.6889; 4, fps 

M=.203; 

p=2116; %, lbt/ft-2 

Q=.7*p*M*M; AP ubty fe. 2 

alpha=11.4/57.3; 4 rad 

u0=cos(alpha)*U; 

thO=alpha; 4% rad - trim point is level flight 
sigma_cmd=3/57 .3; “4 rad 

sigma_alpha=5/U; /r ad 

omegal=40; % rad/s - Actuator bandwidths 
omega2=80; 4, rad/s 

omega3=5; % rad/s 

rThol=0.1: % DLC drag to lift ratio 
rFho2z=0- % DLC moment to lift ratio 


% F-14 stability derivative 
CLt=1.49534913; 
CDt=0.37405269; 


CMt=0; 
CDU=0; 

CLU=0; 

CMU=0O ; 

CDA=0.0208*57 .3; 4 
CLA=0 .0799*57.3; yi 
CMA=-0.0115*57.3; i 
CLQ=5.45; i 
CMQ=-14.3; ‘ 
CLAD=-0.51; i 
CMAD=-0.93; ‘ 
CLIS=0.0141*57.3; y/ 


data 

rad ~-1 
rad°-i 
rada =i 
rad’ -1 
rad -1i 
rad°-1 
rad°~-1i 
rad°-i 


CMIS=-0 .0201*57 .3; Gad) a 


4%, Scale initial DLC for -0.1 g accel at full deflection of 0.5 rad 
CLDLC=-0.1*CLt/0.5; 4 rvrad°-1 

CDDLC=rho1*CLDLC; % rad7~1 

CMDLC=rho2*CLDLC ; 


% Determine the wing body derivatives: 

xc=-CMIS/CLIS; 4% vatio of tail lever arm to mean chord 
CDAwb=CDA; 

CLAwb=CLA=CLIS; 

CMAwb=CMA-xc*CLIS; 

CLQwb=CLQ-2*xc*CLIS; 

CMQwb=CMQ+2*xc°~ 2¥*CLIS; 

CLADwb=CLAD+2*xc*CLIS; 

CMADWb=CMAD-2*xc° 2*CLIS; 


7% determine Rotation Matrix from Lift/Drag to body axis 
T=(-cos(alpha) sin(alpha) 0;-sin(alpha) -cos(alpha) 0;0 0 cbar]; 
QT=Q*S*T; 

c2U=cbar/2/U; 


% Determine Corrected Inertia Matrix 
J=diag((m*U,m+*U, Iyy, 1])-[c2U*QT*[0 0 0;0 CLAD 0;0 CMAD 0 J,[0;0;0];0 0 0 0); 


% Build aero blocks of state matrices 

% states are u,alpha,q,theta,alpha/s,gamma_er/s 

a00=[2*CDt -CLt 0;2*CLt CDt 0; 2*CMt 0 OJ; 

a01=[CDU/U CDAwb 0; CLU/U CLAwb CLQwb*c2U;CMU/U CMAwb CMQwb*c2U] ; 
a0=(QT*(a00+a01) ,-m*g*[cos(th0O);sin(thO);0]; 0 0 1 0]; 
a0(1:2,3)=m*U*(-sin(alpha);cos(alpha)J+a0(1:2,3); 

al=(QT*CLIS*(0 0 0;0 1 2*xc*c2U; 0 xc -2*xc~2*c2U)],[0;0;0];0 0 0 OJ; 
a2=zeros(4,4); 

a0=J\a0; al=J\al: 


4% control inputs are stab(rad),DLC (rad), thrust(lbf) 
bO=zeros(4,2); 

bi=J\[QT*(O 0;CLIS 0;CMIS 0];0 OJ]; 

b2=J\ (Q@T*[0 CDDLC;0 CLDEC 7,0. CMDEC 1/0700): 


% create directed thrust control input 


TO = 13118; 
thetaeO = 0/57.3; 
Px = xc + 3; %4 thrust lever arm 


Bdt = zeros(6,1); 

Bdt(1) = -TO*sin(thetae0O)/m; 
Bdt(2) = -TO*cos(thetae0)/(m*U) ; 
Bdt(3) = -Px*TO*cos(thetae0O)/m; 


7% Build system matrices 
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AO=zeros(6,6); A1=A0; A2=A0; 


A0(1:4,1:4)=a0; A1(1:4,1:4)=al; A2(1:°4;1:4)=a2: 


AO(5,2)=1; 
Ao(6,(2,4])=(-1 1]; 


fa=(AO Ai A2]): 


% exogenous inputs alpha_dist, gamma_cmd 
BiO= zeros(6,2); Bii=Bi0; Bi2=B1i0; 


B10(1:4,1)=a0(: ,2)*sigma_alpha; B10(6,2)=-sigma_cmd; 
B11(1:4,1)=ai(:,2)*sigma_alpha; 
Bi2(1:4,1)=a2(:,2)*sigma_alpha; 


Bia=(BiO Bii B12]; 


B20= [b0; 0 0;0 OJ; 
B20) = B20(:,1) + Bdt: 
B2i1=[bi; zeros(2,2)]; 
B22={b2; zeros(2,2)]): 


B2a=(B20 B21 B22]; % factor required to achieve hinf feasibility 
% Build Output matrices 


% z=(stab,DLC,alpha/s,gamma_err/s,alpha] 

ie 

C=zeros(S,6); Di=zeros(&,2); D2=eye(5,2); 
G(374,°5:6)=eye(2); 

C(S,2)=1; 


% Output criteria: 

% stab<20 deg 

% DLC <40 deg 

% alpha_err< 1.5 deg 


zScale=diag((57.3/20,57.3/40, .00001, .00001,57.3/1.5]); 
C=zScale*C; Di=zScale*D1; D2=zScale*D2; 


zweta=-110-10): 
wet=(3,1]; 


% Build system matrices for uncertainty inputs and outputs 
Delta=0.1*eye(6,3); % Scaling for 10% uncertainty 
B3=Delta*QT; 

C3_0=QT\J(1:3,1:3)\QT*[a01,zeros(3,3)]; 
C3mi—(O7r\al(1:3,:),zeros(3,2)]; 

C3a=[(C3_0,C3_1,zeros(3,6)]; 

D3a—-OT\B2a(1:3,:): 


% Add open loop requirement to maintain a max neg. pitch rate 
4 of 0.5 rad/sec for elev. deflection from trim of -20 deg 
% and a thrust deflection of 5 degrees at 20 Klbs 


de_max = -20; 

q_max = .§; 

thetae_max = -20; 

EO = A0(3,3)*q_max + B20(3,1)*de_max/57.3 + Bdt(3)*thetae_max/57. 3; 
Ei = A1(3,3)*q_max + B21(3,1)*de_max/57.3; 

E2 = 0; 

Ea = [EO Ei E2]; 

theta = 0.1; gam = 1; prec = 1le-6; thres = 1e-9; 


{[z2,xi,K,Z,Rc,Tc,J2,err]=plantopt2a(Aa,Bla,B2a,C,D2,Ea,zeta,wgt,thres,gam,theta,prec) ; 
4% end f14_opt_4 
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